[mirror_ubuntu-jammy-kernel.git] / drivers / mfd / max8925-i2c.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * I2C driver for Maxim MAX8925
 *
 * Copyright (C) 2009 Marvell International Ltd.
 *	Haojian Zhuang <haojian.zhuang@marvell.com>
 */
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/i2c.h>
#include <linux/mfd/max8925.h>
#include <linux/slab.h>

#define RTC_I2C_ADDR		0x68
#define ADC_I2C_ADDR		0x47

static inline int max8925_read_device(struct i2c_client *i2c,
				      int reg, int bytes, void *dest)
{
	int ret;

	if (bytes > 1)
		ret = i2c_smbus_read_i2c_block_data(i2c, reg, bytes, dest);
	else {
		ret = i2c_smbus_read_byte_data(i2c, reg);
		if (ret < 0)
			return ret;
		*(unsigned char *)dest = (unsigned char)ret;
	}
	return ret;
}

static inline int max8925_write_device(struct i2c_client *i2c,
				       int reg, int bytes, void *src)
{
	unsigned char buf[9];
	int ret;

	buf[0] = (unsigned char)reg;
	memcpy(&buf[1], src, bytes);

	ret = i2c_master_send(i2c, buf, bytes + 1);
	if (ret < 0)
		return ret;
	return 0;
}

int max8925_reg_read(struct i2c_client *i2c, int reg)
{
	struct max8925_chip *chip = i2c_get_clientdata(i2c);
	unsigned char data = 0;
	int ret;

	mutex_lock(&chip->io_lock);
	ret = max8925_read_device(i2c, reg, 1, &data);
	mutex_unlock(&chip->io_lock);

	if (ret < 0)
		return ret;
	else
		return (int)data;
}
EXPORT_SYMBOL(max8925_reg_read);

int max8925_reg_write(struct i2c_client *i2c, int reg,
		unsigned char data)
{
	struct max8925_chip *chip = i2c_get_clientdata(i2c);
	int ret;

	mutex_lock(&chip->io_lock);
	ret = max8925_write_device(i2c, reg, 1, &data);
	mutex_unlock(&chip->io_lock);

	return ret;
}
EXPORT_SYMBOL(max8925_reg_write);

int max8925_bulk_read(struct i2c_client *i2c, int reg,
		int count, unsigned char *buf)
{
	struct max8925_chip *chip = i2c_get_clientdata(i2c);
	int ret;

	mutex_lock(&chip->io_lock);
	ret = max8925_read_device(i2c, reg, count, buf);
	mutex_unlock(&chip->io_lock);

	return ret;
}
EXPORT_SYMBOL(max8925_bulk_read);

int max8925_bulk_write(struct i2c_client *i2c, int reg,
		int count, unsigned char *buf)
{
	struct max8925_chip *chip = i2c_get_clientdata(i2c);
	int ret;

	mutex_lock(&chip->io_lock);
	ret = max8925_write_device(i2c, reg, count, buf);
	mutex_unlock(&chip->io_lock);

	return ret;
}
EXPORT_SYMBOL(max8925_bulk_write);

int max8925_set_bits(struct i2c_client *i2c, int reg,
		unsigned char mask, unsigned char data)
{
	struct max8925_chip *chip = i2c_get_clientdata(i2c);
	unsigned char value;
	int ret;

	mutex_lock(&chip->io_lock);
	ret = max8925_read_device(i2c, reg, 1, &value);
	if (ret < 0)
		goto out;
	value &= ~mask;
	value |= data;
	ret = max8925_write_device(i2c, reg, 1, &value);
out:
	mutex_unlock(&chip->io_lock);
	return ret;
}
EXPORT_SYMBOL(max8925_set_bits);


static const struct i2c_device_id max8925_id_table[] = {
	{ "max8925", 0 },
	{ },
};

static int max8925_dt_init(struct device_node *np, struct device *dev,
			   struct max8925_platform_data *pdata)
{
	int ret;

	ret = of_property_read_u32(np, "maxim,tsc-irq", &pdata->tsc_irq);
	if (ret) {
		dev_err(dev, "Not found maxim,tsc-irq property\n");
		return -EINVAL;
	}
	return 0;
}

static int max8925_probe(struct i2c_client *client,
				   const struct i2c_device_id *id)
{
	struct max8925_platform_data *pdata = dev_get_platdata(&client->dev);
	struct max8925_chip *chip;
	struct device_node *node = client->dev.of_node;

	if (node && !pdata) {
		/* parse DT to get platform data */
		pdata = devm_kzalloc(&client->dev,
				     sizeof(struct max8925_platform_data),
				     GFP_KERNEL);
		if (!pdata)
			return -ENOMEM;

		if (max8925_dt_init(node, &client->dev, pdata))
			return -EINVAL;
	} else if (!pdata) {
		pr_info("%s: platform data is missing\n", __func__);
		return -EINVAL;
	}

	chip = devm_kzalloc(&client->dev,
			    sizeof(struct max8925_chip), GFP_KERNEL);
	if (chip == NULL)
		return -ENOMEM;
	chip->i2c = client;
	chip->dev = &client->dev;
	i2c_set_clientdata(client, chip);
	dev_set_drvdata(chip->dev, chip);
	mutex_init(&chip->io_lock);

	chip->rtc = i2c_new_dummy_device(chip->i2c->adapter, RTC_I2C_ADDR);
	if (IS_ERR(chip->rtc)) {
		dev_err(chip->dev, "Failed to allocate I2C device for RTC\n");
		return PTR_ERR(chip->rtc);
	}
	i2c_set_clientdata(chip->rtc, chip);

	chip->adc = i2c_new_dummy_device(chip->i2c->adapter, ADC_I2C_ADDR);
	if (IS_ERR(chip->adc)) {
		dev_err(chip->dev, "Failed to allocate I2C device for ADC\n");
		i2c_unregister_device(chip->rtc);
		return PTR_ERR(chip->adc);
	}
	i2c_set_clientdata(chip->adc, chip);

	device_init_wakeup(&client->dev, 1);

	max8925_device_init(chip, pdata);

	return 0;
}

static int max8925_remove(struct i2c_client *client)
{
	struct max8925_chip *chip = i2c_get_clientdata(client);

	max8925_device_exit(chip);
	i2c_unregister_device(chip->adc);
	i2c_unregister_device(chip->rtc);
	return 0;
}

#ifdef CONFIG_PM_SLEEP
static int max8925_suspend(struct device *dev)
{
	struct i2c_client *client = to_i2c_client(dev);
	struct max8925_chip *chip = i2c_get_clientdata(client);

	if (device_may_wakeup(dev) && chip->wakeup_flag)
		enable_irq_wake(chip->core_irq);
	return 0;
}

static int max8925_resume(struct device *dev)
{
	struct i2c_client *client = to_i2c_client(dev);
	struct max8925_chip *chip = i2c_get_clientdata(client);

	if (device_may_wakeup(dev) && chip->wakeup_flag)
		disable_irq_wake(chip->core_irq);
	return 0;
}
#endif

static SIMPLE_DEV_PM_OPS(max8925_pm_ops, max8925_suspend, max8925_resume);

static const struct of_device_id max8925_dt_ids[] = {
	{ .compatible = "maxim,max8925", },
	{},
};

static struct i2c_driver max8925_driver = {
	.driver	= {
		.name	= "max8925",
		.pm     = &max8925_pm_ops,
		.of_match_table = max8925_dt_ids,
	},
	.probe		= max8925_probe,
	.remove		= max8925_remove,
	.id_table	= max8925_id_table,
};

static int __init max8925_i2c_init(void)
{
	int ret;

	ret = i2c_add_driver(&max8925_driver);
	if (ret != 0)
		pr_err("Failed to register MAX8925 I2C driver: %d\n", ret);

	return ret;
}
subsys_initcall(max8925_i2c_init);
Commit	Line	Data
d2912cb1	1	// SPDX-License-Identifier: GPL-2.0-only
d50f8f33 HZ	2	/*
	3	* I2C driver for Maxim MAX8925
	4	*
	5	* Copyright (C) 2009 Marvell International Ltd.
	6	* Haojian Zhuang <haojian.zhuang@marvell.com>
d50f8f33 HZ	7	*/
d50f8f33 HZ	8	#include <linux/kernel.h>
9eb5f9ba	9	#include <linux/init.h>
d50f8f33 HZ	10	#include <linux/platform_device.h>
	11	#include <linux/i2c.h>
	12	#include <linux/mfd/max8925.h>
5a0e3ad6	13	#include <linux/slab.h>
d50f8f33	14
b13c0df5 HZ	15	#define RTC_I2C_ADDR 0x68
	16	#define ADC_I2C_ADDR 0x47
	17
d50f8f33 HZ	18	static inline int max8925_read_device(struct i2c_client *i2c,
	19	int reg, int bytes, void *dest)
	20	{
d50f8f33 HZ	21	int ret;
d50f8f33 HZ	22
b13c0df5 HZ	23	if (bytes > 1)
	24	ret = i2c_smbus_read_i2c_block_data(i2c, reg, bytes, dest);
	25	else {
	26	ret = i2c_smbus_read_byte_data(i2c, reg);
	27	if (ret < 0)
	28	return ret;
	29	(unsigned char )dest = (unsigned char)ret;
	30	}
	31	return ret;
d50f8f33 HZ	32	}
	33
	34	static inline int max8925_write_device(struct i2c_client *i2c,
	35	int reg, int bytes, void *src)
	36	{
87bd1c92	37	unsigned char buf[9];
d50f8f33 HZ	38	int ret;
	39
	40	buf[0] = (unsigned char)reg;
	41	memcpy(&buf[1], src, bytes);
	42
	43	ret = i2c_master_send(i2c, buf, bytes + 1);
	44	if (ret < 0)
	45	return ret;
	46	return 0;
	47	}
	48
	49	int max8925_reg_read(struct i2c_client *i2c, int reg)
	50	{
	51	struct max8925_chip *chip = i2c_get_clientdata(i2c);
b13c0df5	52	unsigned char data = 0;
d50f8f33 HZ	53	int ret;
	54
	55	mutex_lock(&chip->io_lock);
	56	ret = max8925_read_device(i2c, reg, 1, &data);
	57	mutex_unlock(&chip->io_lock);
	58
	59	if (ret < 0)
	60	return ret;
	61	else
	62	return (int)data;
	63	}
	64	EXPORT_SYMBOL(max8925_reg_read);
	65
	66	int max8925_reg_write(struct i2c_client *i2c, int reg,
	67	unsigned char data)
	68	{
	69	struct max8925_chip *chip = i2c_get_clientdata(i2c);
	70	int ret;
	71
	72	mutex_lock(&chip->io_lock);
	73	ret = max8925_write_device(i2c, reg, 1, &data);
	74	mutex_unlock(&chip->io_lock);
	75
	76	return ret;
	77	}
	78	EXPORT_SYMBOL(max8925_reg_write);
	79
	80	int max8925_bulk_read(struct i2c_client *i2c, int reg,
	81	int count, unsigned char *buf)
	82	{
	83	struct max8925_chip *chip = i2c_get_clientdata(i2c);
	84	int ret;
	85
	86	mutex_lock(&chip->io_lock);
	87	ret = max8925_read_device(i2c, reg, count, buf);
	88	mutex_unlock(&chip->io_lock);
	89
	90	return ret;
	91	}
	92	EXPORT_SYMBOL(max8925_bulk_read);
	93
	94	int max8925_bulk_write(struct i2c_client *i2c, int reg,
	95	int count, unsigned char *buf)
	96	{
	97	struct max8925_chip *chip = i2c_get_clientdata(i2c);
	98	int ret;
	99
	100	mutex_lock(&chip->io_lock);
	101	ret = max8925_write_device(i2c, reg, count, buf);
	102	mutex_unlock(&chip->io_lock);
	103
	104	return ret;
	105	}
	106	EXPORT_SYMBOL(max8925_bulk_write);
	107
	108	int max8925_set_bits(struct i2c_client *i2c, int reg,
	109	unsigned char mask, unsigned char data)
	110	{
	111	struct max8925_chip *chip = i2c_get_clientdata(i2c);
	112	unsigned char value;
	113	int ret;
	114
	115	mutex_lock(&chip->io_lock);
	116	ret = max8925_read_device(i2c, reg, 1, &value);
117	if (ret < 0)
118	goto out;
119	value &= ~mask;
120	value \|= data;
121	ret = max8925_write_device(i2c, reg, 1, &value);
122	out:
123	mutex_unlock(&chip->io_lock);
124	return ret;
125	}
126	EXPORT_SYMBOL(max8925_set_bits);
127
128
129	static const struct i2c_device_id max8925_id_table[] = {
130	{ "max8925", 0 },
b13c0df5	131	{ },
d50f8f33	132	};
d50f8f33	133
4e405ae2 QX	134	static int max8925_dt_init(struct device_node np, struct device dev,
	135	struct max8925_platform_data *pdata)
	136	{
	137	int ret;
	138
	139	ret = of_property_read_u32(np, "maxim,tsc-irq", &pdata->tsc_irq);
	140	if (ret) {
	141	dev_err(dev, "Not found maxim,tsc-irq property\n");
	142	return -EINVAL;
	143	}
	144	return 0;
	145	}
	146
f791be49	147	static int max8925_probe(struct i2c_client *client,
d50f8f33 HZ	148	const struct i2c_device_id *id)
d50f8f33 HZ	149	{
334a41ce	150	struct max8925_platform_data *pdata = dev_get_platdata(&client->dev);
09530751	151	struct max8925_chip *chip;
4e405ae2 QX	152	struct device_node *node = client->dev.of_node;
	153
	154	if (node && !pdata) {
	155	/* parse DT to get platform data */
	156	pdata = devm_kzalloc(&client->dev,
	157	sizeof(struct max8925_platform_data),
	158	GFP_KERNEL);
	159	if (!pdata)
	160	return -ENOMEM;
	161
	162	if (max8925_dt_init(node, &client->dev, pdata))
	163	return -EINVAL;
	164	} else if (!pdata) {
d50f8f33 HZ	165	pr_info("%s: platform data is missing\n", __func__);
	166	return -EINVAL;
	167	}
d50f8f33	168
02c7d848 LJ	169	chip = devm_kzalloc(&client->dev,
02c7d848 LJ	170	sizeof(struct max8925_chip), GFP_KERNEL);
d50f8f33 HZ	171	if (chip == NULL)
	172	return -ENOMEM;
	173	chip->i2c = client;
d50f8f33	174	chip->dev = &client->dev;
b13c0df5	175	i2c_set_clientdata(client, chip);
d50f8f33	176	dev_set_drvdata(chip->dev, chip);
b13c0df5 HZ	177	mutex_init(&chip->io_lock);
b13c0df5 HZ	178
ddbf6ffe WS	179	chip->rtc = i2c_new_dummy_device(chip->i2c->adapter, RTC_I2C_ADDR);
ddbf6ffe WS	180	if (IS_ERR(chip->rtc)) {
96cf3ded	181	dev_err(chip->dev, "Failed to allocate I2C device for RTC\n");
ddbf6ffe	182	return PTR_ERR(chip->rtc);
96cf3ded	183	}
b13c0df5 HZ	184	i2c_set_clientdata(chip->rtc, chip);
b13c0df5 HZ	185
ddbf6ffe WS	186	chip->adc = i2c_new_dummy_device(chip->i2c->adapter, ADC_I2C_ADDR);
ddbf6ffe WS	187	if (IS_ERR(chip->adc)) {
96cf3ded KK	188	dev_err(chip->dev, "Failed to allocate I2C device for ADC\n");
96cf3ded KK	189	i2c_unregister_device(chip->rtc);
ddbf6ffe	190	return PTR_ERR(chip->adc);
96cf3ded	191	}
b13c0df5 HZ	192	i2c_set_clientdata(chip->adc, chip);
b13c0df5 HZ	193
ba74e80e KL	194	device_init_wakeup(&client->dev, 1);
ba74e80e KL	195
d50f8f33 HZ	196	max8925_device_init(chip, pdata);
	197
	198	return 0;
	199	}
	200
4740f73f	201	static int max8925_remove(struct i2c_client *client)
d50f8f33 HZ	202	{
	203	struct max8925_chip *chip = i2c_get_clientdata(client);
	204
	205	max8925_device_exit(chip);
b13c0df5 HZ	206	i2c_unregister_device(chip->adc);
b13c0df5 HZ	207	i2c_unregister_device(chip->rtc);
d50f8f33 HZ	208	return 0;
	209	}
	210
ba74e80e KL	211	#ifdef CONFIG_PM_SLEEP
	212	static int max8925_suspend(struct device *dev)
	213	{
1b5420e1	214	struct i2c_client *client = to_i2c_client(dev);
ba74e80e KL	215	struct max8925_chip *chip = i2c_get_clientdata(client);
	216
	217	if (device_may_wakeup(dev) && chip->wakeup_flag)
	218	enable_irq_wake(chip->core_irq);
	219	return 0;
	220	}
	221
	222	static int max8925_resume(struct device *dev)
	223	{
1b5420e1	224	struct i2c_client *client = to_i2c_client(dev);
ba74e80e KL	225	struct max8925_chip *chip = i2c_get_clientdata(client);
	226
	227	if (device_may_wakeup(dev) && chip->wakeup_flag)
	228	disable_irq_wake(chip->core_irq);
	229	return 0;
	230	}
	231	#endif
	232
	233	static SIMPLE_DEV_PM_OPS(max8925_pm_ops, max8925_suspend, max8925_resume);
	234
4e405ae2 QX	235	static const struct of_device_id max8925_dt_ids[] = {
	236	{ .compatible = "maxim,max8925", },
	237	{},
	238	};
4e405ae2	239
d50f8f33 HZ	240	static struct i2c_driver max8925_driver = {
	241	.driver = {
	242	.name = "max8925",
ba74e80e	243	.pm = &max8925_pm_ops,
52c2c6eb	244	.of_match_table = max8925_dt_ids,
d50f8f33 HZ	245	},
d50f8f33 HZ	246	.probe = max8925_probe,
84449216	247	.remove = max8925_remove,
d50f8f33 HZ	248	.id_table = max8925_id_table,
	249	};
	250
	251	static int __init max8925_i2c_init(void)
	252	{
	253	int ret;
4ed8f718	254
d50f8f33 HZ	255	ret = i2c_add_driver(&max8925_driver);
	256	if (ret != 0)
	257	pr_err("Failed to register MAX8925 I2C driver: %d\n", ret);
4ed8f718	258
d50f8f33 HZ	259	return ret;
	260	}
	261	subsys_initcall(max8925_i2c_init);