18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Copyright (C) 2007-2010 ST-Ericsson
48c2ecf20Sopenharmony_ci * Low-level core for exclusive access to the AB3100 IC on the I2C bus
58c2ecf20Sopenharmony_ci * and some basic chip-configuration.
68c2ecf20Sopenharmony_ci * Author: Linus Walleij <linus.walleij@stericsson.com>
78c2ecf20Sopenharmony_ci */
88c2ecf20Sopenharmony_ci
98c2ecf20Sopenharmony_ci#include <linux/i2c.h>
108c2ecf20Sopenharmony_ci#include <linux/mutex.h>
118c2ecf20Sopenharmony_ci#include <linux/list.h>
128c2ecf20Sopenharmony_ci#include <linux/notifier.h>
138c2ecf20Sopenharmony_ci#include <linux/slab.h>
148c2ecf20Sopenharmony_ci#include <linux/err.h>
158c2ecf20Sopenharmony_ci#include <linux/init.h>
168c2ecf20Sopenharmony_ci#include <linux/platform_device.h>
178c2ecf20Sopenharmony_ci#include <linux/device.h>
188c2ecf20Sopenharmony_ci#include <linux/interrupt.h>
198c2ecf20Sopenharmony_ci#include <linux/random.h>
208c2ecf20Sopenharmony_ci#include <linux/debugfs.h>
218c2ecf20Sopenharmony_ci#include <linux/seq_file.h>
228c2ecf20Sopenharmony_ci#include <linux/uaccess.h>
238c2ecf20Sopenharmony_ci#include <linux/mfd/core.h>
248c2ecf20Sopenharmony_ci#include <linux/mfd/ab3100.h>
258c2ecf20Sopenharmony_ci#include <linux/mfd/abx500.h>
268c2ecf20Sopenharmony_ci
278c2ecf20Sopenharmony_ci/* These are the only registers inside AB3100 used in this main file */
288c2ecf20Sopenharmony_ci
298c2ecf20Sopenharmony_ci/* Interrupt event registers */
308c2ecf20Sopenharmony_ci#define AB3100_EVENTA1		0x21
318c2ecf20Sopenharmony_ci#define AB3100_EVENTA2		0x22
328c2ecf20Sopenharmony_ci#define AB3100_EVENTA3		0x23
338c2ecf20Sopenharmony_ci
348c2ecf20Sopenharmony_ci/* AB3100 DAC converter registers */
358c2ecf20Sopenharmony_ci#define AB3100_DIS		0x00
368c2ecf20Sopenharmony_ci#define AB3100_D0C		0x01
378c2ecf20Sopenharmony_ci#define AB3100_D1C		0x02
388c2ecf20Sopenharmony_ci#define AB3100_D2C		0x03
398c2ecf20Sopenharmony_ci#define AB3100_D3C		0x04
408c2ecf20Sopenharmony_ci
418c2ecf20Sopenharmony_ci/* Chip ID register */
428c2ecf20Sopenharmony_ci#define AB3100_CID		0x20
438c2ecf20Sopenharmony_ci
448c2ecf20Sopenharmony_ci/* AB3100 interrupt registers */
458c2ecf20Sopenharmony_ci#define AB3100_IMRA1		0x24
468c2ecf20Sopenharmony_ci#define AB3100_IMRA2		0x25
478c2ecf20Sopenharmony_ci#define AB3100_IMRA3		0x26
488c2ecf20Sopenharmony_ci#define AB3100_IMRB1		0x2B
498c2ecf20Sopenharmony_ci#define AB3100_IMRB2		0x2C
508c2ecf20Sopenharmony_ci#define AB3100_IMRB3		0x2D
518c2ecf20Sopenharmony_ci
528c2ecf20Sopenharmony_ci/* System Power Monitoring and control registers */
538c2ecf20Sopenharmony_ci#define AB3100_MCA		0x2E
548c2ecf20Sopenharmony_ci#define AB3100_MCB		0x2F
558c2ecf20Sopenharmony_ci
568c2ecf20Sopenharmony_ci/* SIM power up */
578c2ecf20Sopenharmony_ci#define AB3100_SUP		0x50
588c2ecf20Sopenharmony_ci
598c2ecf20Sopenharmony_ci/*
608c2ecf20Sopenharmony_ci * I2C communication
618c2ecf20Sopenharmony_ci *
628c2ecf20Sopenharmony_ci * The AB3100 is usually assigned address 0x48 (7-bit)
638c2ecf20Sopenharmony_ci * The chip is defined in the platform i2c_board_data section.
648c2ecf20Sopenharmony_ci */
658c2ecf20Sopenharmony_cistatic int ab3100_get_chip_id(struct device *dev)
668c2ecf20Sopenharmony_ci{
678c2ecf20Sopenharmony_ci	struct ab3100 *ab3100 = dev_get_drvdata(dev->parent);
688c2ecf20Sopenharmony_ci
698c2ecf20Sopenharmony_ci	return (int)ab3100->chip_id;
708c2ecf20Sopenharmony_ci}
718c2ecf20Sopenharmony_ci
728c2ecf20Sopenharmony_cistatic int ab3100_set_register_interruptible(struct ab3100 *ab3100,
738c2ecf20Sopenharmony_ci	u8 reg, u8 regval)
748c2ecf20Sopenharmony_ci{
758c2ecf20Sopenharmony_ci	u8 regandval[2] = {reg, regval};
768c2ecf20Sopenharmony_ci	int err;
778c2ecf20Sopenharmony_ci
788c2ecf20Sopenharmony_ci	err = mutex_lock_interruptible(&ab3100->access_mutex);
798c2ecf20Sopenharmony_ci	if (err)
808c2ecf20Sopenharmony_ci		return err;
818c2ecf20Sopenharmony_ci
828c2ecf20Sopenharmony_ci	/*
838c2ecf20Sopenharmony_ci	 * A two-byte write message with the first byte containing the register
848c2ecf20Sopenharmony_ci	 * number and the second byte containing the value to be written
858c2ecf20Sopenharmony_ci	 * effectively sets a register in the AB3100.
868c2ecf20Sopenharmony_ci	 */
878c2ecf20Sopenharmony_ci	err = i2c_master_send(ab3100->i2c_client, regandval, 2);
888c2ecf20Sopenharmony_ci	if (err < 0) {
898c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
908c2ecf20Sopenharmony_ci			"write error (write register): %d\n",
918c2ecf20Sopenharmony_ci			err);
928c2ecf20Sopenharmony_ci	} else if (err != 2) {
938c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
948c2ecf20Sopenharmony_ci			"write error (write register)\n"
958c2ecf20Sopenharmony_ci			"  %d bytes transferred (expected 2)\n",
968c2ecf20Sopenharmony_ci			err);
978c2ecf20Sopenharmony_ci		err = -EIO;
988c2ecf20Sopenharmony_ci	} else {
998c2ecf20Sopenharmony_ci		/* All is well */
1008c2ecf20Sopenharmony_ci		err = 0;
1018c2ecf20Sopenharmony_ci	}
1028c2ecf20Sopenharmony_ci	mutex_unlock(&ab3100->access_mutex);
1038c2ecf20Sopenharmony_ci	return err;
1048c2ecf20Sopenharmony_ci}
1058c2ecf20Sopenharmony_ci
1068c2ecf20Sopenharmony_cistatic int set_register_interruptible(struct device *dev,
1078c2ecf20Sopenharmony_ci	u8 bank, u8 reg, u8 value)
1088c2ecf20Sopenharmony_ci{
1098c2ecf20Sopenharmony_ci	struct ab3100 *ab3100 = dev_get_drvdata(dev->parent);
1108c2ecf20Sopenharmony_ci
1118c2ecf20Sopenharmony_ci	return ab3100_set_register_interruptible(ab3100, reg, value);
1128c2ecf20Sopenharmony_ci}
1138c2ecf20Sopenharmony_ci
1148c2ecf20Sopenharmony_ci/*
1158c2ecf20Sopenharmony_ci * The test registers exist at an I2C bus address up one
1168c2ecf20Sopenharmony_ci * from the ordinary base. They are not supposed to be used
1178c2ecf20Sopenharmony_ci * in production code, but sometimes you have to do that
1188c2ecf20Sopenharmony_ci * anyway. It's currently only used from this file so declare
1198c2ecf20Sopenharmony_ci * it static and do not export.
1208c2ecf20Sopenharmony_ci */
1218c2ecf20Sopenharmony_cistatic int ab3100_set_test_register_interruptible(struct ab3100 *ab3100,
1228c2ecf20Sopenharmony_ci				    u8 reg, u8 regval)
1238c2ecf20Sopenharmony_ci{
1248c2ecf20Sopenharmony_ci	u8 regandval[2] = {reg, regval};
1258c2ecf20Sopenharmony_ci	int err;
1268c2ecf20Sopenharmony_ci
1278c2ecf20Sopenharmony_ci	err = mutex_lock_interruptible(&ab3100->access_mutex);
1288c2ecf20Sopenharmony_ci	if (err)
1298c2ecf20Sopenharmony_ci		return err;
1308c2ecf20Sopenharmony_ci
1318c2ecf20Sopenharmony_ci	err = i2c_master_send(ab3100->testreg_client, regandval, 2);
1328c2ecf20Sopenharmony_ci	if (err < 0) {
1338c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
1348c2ecf20Sopenharmony_ci			"write error (write test register): %d\n",
1358c2ecf20Sopenharmony_ci			err);
1368c2ecf20Sopenharmony_ci	} else if (err != 2) {
1378c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
1388c2ecf20Sopenharmony_ci			"write error (write test register)\n"
1398c2ecf20Sopenharmony_ci			"  %d bytes transferred (expected 2)\n",
1408c2ecf20Sopenharmony_ci			err);
1418c2ecf20Sopenharmony_ci		err = -EIO;
1428c2ecf20Sopenharmony_ci	} else {
1438c2ecf20Sopenharmony_ci		/* All is well */
1448c2ecf20Sopenharmony_ci		err = 0;
1458c2ecf20Sopenharmony_ci	}
1468c2ecf20Sopenharmony_ci	mutex_unlock(&ab3100->access_mutex);
1478c2ecf20Sopenharmony_ci
1488c2ecf20Sopenharmony_ci	return err;
1498c2ecf20Sopenharmony_ci}
1508c2ecf20Sopenharmony_ci
1518c2ecf20Sopenharmony_cistatic int ab3100_get_register_interruptible(struct ab3100 *ab3100,
1528c2ecf20Sopenharmony_ci					     u8 reg, u8 *regval)
1538c2ecf20Sopenharmony_ci{
1548c2ecf20Sopenharmony_ci	int err;
1558c2ecf20Sopenharmony_ci
1568c2ecf20Sopenharmony_ci	err = mutex_lock_interruptible(&ab3100->access_mutex);
1578c2ecf20Sopenharmony_ci	if (err)
1588c2ecf20Sopenharmony_ci		return err;
1598c2ecf20Sopenharmony_ci
1608c2ecf20Sopenharmony_ci	/*
1618c2ecf20Sopenharmony_ci	 * AB3100 require an I2C "stop" command between each message, else
1628c2ecf20Sopenharmony_ci	 * it will not work. The only way of achieveing this with the
1638c2ecf20Sopenharmony_ci	 * message transport layer is to send the read and write messages
1648c2ecf20Sopenharmony_ci	 * separately.
1658c2ecf20Sopenharmony_ci	 */
1668c2ecf20Sopenharmony_ci	err = i2c_master_send(ab3100->i2c_client, &reg, 1);
1678c2ecf20Sopenharmony_ci	if (err < 0) {
1688c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
1698c2ecf20Sopenharmony_ci			"write error (send register address): %d\n",
1708c2ecf20Sopenharmony_ci			err);
1718c2ecf20Sopenharmony_ci		goto get_reg_out_unlock;
1728c2ecf20Sopenharmony_ci	} else if (err != 1) {
1738c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
1748c2ecf20Sopenharmony_ci			"write error (send register address)\n"
1758c2ecf20Sopenharmony_ci			"  %d bytes transferred (expected 1)\n",
1768c2ecf20Sopenharmony_ci			err);
1778c2ecf20Sopenharmony_ci		err = -EIO;
1788c2ecf20Sopenharmony_ci		goto get_reg_out_unlock;
1798c2ecf20Sopenharmony_ci	} else {
1808c2ecf20Sopenharmony_ci		/* All is well */
1818c2ecf20Sopenharmony_ci		err = 0;
1828c2ecf20Sopenharmony_ci	}
1838c2ecf20Sopenharmony_ci
1848c2ecf20Sopenharmony_ci	err = i2c_master_recv(ab3100->i2c_client, regval, 1);
1858c2ecf20Sopenharmony_ci	if (err < 0) {
1868c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
1878c2ecf20Sopenharmony_ci			"write error (read register): %d\n",
1888c2ecf20Sopenharmony_ci			err);
1898c2ecf20Sopenharmony_ci		goto get_reg_out_unlock;
1908c2ecf20Sopenharmony_ci	} else if (err != 1) {
1918c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
1928c2ecf20Sopenharmony_ci			"write error (read register)\n"
1938c2ecf20Sopenharmony_ci			"  %d bytes transferred (expected 1)\n",
1948c2ecf20Sopenharmony_ci			err);
1958c2ecf20Sopenharmony_ci		err = -EIO;
1968c2ecf20Sopenharmony_ci		goto get_reg_out_unlock;
1978c2ecf20Sopenharmony_ci	} else {
1988c2ecf20Sopenharmony_ci		/* All is well */
1998c2ecf20Sopenharmony_ci		err = 0;
2008c2ecf20Sopenharmony_ci	}
2018c2ecf20Sopenharmony_ci
2028c2ecf20Sopenharmony_ci get_reg_out_unlock:
2038c2ecf20Sopenharmony_ci	mutex_unlock(&ab3100->access_mutex);
2048c2ecf20Sopenharmony_ci	return err;
2058c2ecf20Sopenharmony_ci}
2068c2ecf20Sopenharmony_ci
2078c2ecf20Sopenharmony_cistatic int get_register_interruptible(struct device *dev, u8 bank, u8 reg,
2088c2ecf20Sopenharmony_ci				      u8 *value)
2098c2ecf20Sopenharmony_ci{
2108c2ecf20Sopenharmony_ci	struct ab3100 *ab3100 = dev_get_drvdata(dev->parent);
2118c2ecf20Sopenharmony_ci
2128c2ecf20Sopenharmony_ci	return ab3100_get_register_interruptible(ab3100, reg, value);
2138c2ecf20Sopenharmony_ci}
2148c2ecf20Sopenharmony_ci
2158c2ecf20Sopenharmony_cistatic int ab3100_get_register_page_interruptible(struct ab3100 *ab3100,
2168c2ecf20Sopenharmony_ci			     u8 first_reg, u8 *regvals, u8 numregs)
2178c2ecf20Sopenharmony_ci{
2188c2ecf20Sopenharmony_ci	int err;
2198c2ecf20Sopenharmony_ci
2208c2ecf20Sopenharmony_ci	if (ab3100->chip_id == 0xa0 ||
2218c2ecf20Sopenharmony_ci	    ab3100->chip_id == 0xa1)
2228c2ecf20Sopenharmony_ci		/* These don't support paged reads */
2238c2ecf20Sopenharmony_ci		return -EIO;
2248c2ecf20Sopenharmony_ci
2258c2ecf20Sopenharmony_ci	err = mutex_lock_interruptible(&ab3100->access_mutex);
2268c2ecf20Sopenharmony_ci	if (err)
2278c2ecf20Sopenharmony_ci		return err;
2288c2ecf20Sopenharmony_ci
2298c2ecf20Sopenharmony_ci	/*
2308c2ecf20Sopenharmony_ci	 * Paged read also require an I2C "stop" command.
2318c2ecf20Sopenharmony_ci	 */
2328c2ecf20Sopenharmony_ci	err = i2c_master_send(ab3100->i2c_client, &first_reg, 1);
2338c2ecf20Sopenharmony_ci	if (err < 0) {
2348c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
2358c2ecf20Sopenharmony_ci			"write error (send first register address): %d\n",
2368c2ecf20Sopenharmony_ci			err);
2378c2ecf20Sopenharmony_ci		goto get_reg_page_out_unlock;
2388c2ecf20Sopenharmony_ci	} else if (err != 1) {
2398c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
2408c2ecf20Sopenharmony_ci			"write error (send first register address)\n"
2418c2ecf20Sopenharmony_ci			"  %d bytes transferred (expected 1)\n",
2428c2ecf20Sopenharmony_ci			err);
2438c2ecf20Sopenharmony_ci		err = -EIO;
2448c2ecf20Sopenharmony_ci		goto get_reg_page_out_unlock;
2458c2ecf20Sopenharmony_ci	}
2468c2ecf20Sopenharmony_ci
2478c2ecf20Sopenharmony_ci	err = i2c_master_recv(ab3100->i2c_client, regvals, numregs);
2488c2ecf20Sopenharmony_ci	if (err < 0) {
2498c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
2508c2ecf20Sopenharmony_ci			"write error (read register page): %d\n",
2518c2ecf20Sopenharmony_ci			err);
2528c2ecf20Sopenharmony_ci		goto get_reg_page_out_unlock;
2538c2ecf20Sopenharmony_ci	} else if (err != numregs) {
2548c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
2558c2ecf20Sopenharmony_ci			"write error (read register page)\n"
2568c2ecf20Sopenharmony_ci			"  %d bytes transferred (expected %d)\n",
2578c2ecf20Sopenharmony_ci			err, numregs);
2588c2ecf20Sopenharmony_ci		err = -EIO;
2598c2ecf20Sopenharmony_ci		goto get_reg_page_out_unlock;
2608c2ecf20Sopenharmony_ci	}
2618c2ecf20Sopenharmony_ci
2628c2ecf20Sopenharmony_ci	/* All is well */
2638c2ecf20Sopenharmony_ci	err = 0;
2648c2ecf20Sopenharmony_ci
2658c2ecf20Sopenharmony_ci get_reg_page_out_unlock:
2668c2ecf20Sopenharmony_ci	mutex_unlock(&ab3100->access_mutex);
2678c2ecf20Sopenharmony_ci	return err;
2688c2ecf20Sopenharmony_ci}
2698c2ecf20Sopenharmony_ci
2708c2ecf20Sopenharmony_cistatic int get_register_page_interruptible(struct device *dev, u8 bank,
2718c2ecf20Sopenharmony_ci	u8 first_reg, u8 *regvals, u8 numregs)
2728c2ecf20Sopenharmony_ci{
2738c2ecf20Sopenharmony_ci	struct ab3100 *ab3100 = dev_get_drvdata(dev->parent);
2748c2ecf20Sopenharmony_ci
2758c2ecf20Sopenharmony_ci	return ab3100_get_register_page_interruptible(ab3100,
2768c2ecf20Sopenharmony_ci			first_reg, regvals, numregs);
2778c2ecf20Sopenharmony_ci}
2788c2ecf20Sopenharmony_ci
2798c2ecf20Sopenharmony_cistatic int ab3100_mask_and_set_register_interruptible(struct ab3100 *ab3100,
2808c2ecf20Sopenharmony_ci				 u8 reg, u8 andmask, u8 ormask)
2818c2ecf20Sopenharmony_ci{
2828c2ecf20Sopenharmony_ci	u8 regandval[2] = {reg, 0};
2838c2ecf20Sopenharmony_ci	int err;
2848c2ecf20Sopenharmony_ci
2858c2ecf20Sopenharmony_ci	err = mutex_lock_interruptible(&ab3100->access_mutex);
2868c2ecf20Sopenharmony_ci	if (err)
2878c2ecf20Sopenharmony_ci		return err;
2888c2ecf20Sopenharmony_ci
2898c2ecf20Sopenharmony_ci	/* First read out the target register */
2908c2ecf20Sopenharmony_ci	err = i2c_master_send(ab3100->i2c_client, &reg, 1);
2918c2ecf20Sopenharmony_ci	if (err < 0) {
2928c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
2938c2ecf20Sopenharmony_ci			"write error (maskset send address): %d\n",
2948c2ecf20Sopenharmony_ci			err);
2958c2ecf20Sopenharmony_ci		goto get_maskset_unlock;
2968c2ecf20Sopenharmony_ci	} else if (err != 1) {
2978c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
2988c2ecf20Sopenharmony_ci			"write error (maskset send address)\n"
2998c2ecf20Sopenharmony_ci			"  %d bytes transferred (expected 1)\n",
3008c2ecf20Sopenharmony_ci			err);
3018c2ecf20Sopenharmony_ci		err = -EIO;
3028c2ecf20Sopenharmony_ci		goto get_maskset_unlock;
3038c2ecf20Sopenharmony_ci	}
3048c2ecf20Sopenharmony_ci
3058c2ecf20Sopenharmony_ci	err = i2c_master_recv(ab3100->i2c_client, &regandval[1], 1);
3068c2ecf20Sopenharmony_ci	if (err < 0) {
3078c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
3088c2ecf20Sopenharmony_ci			"write error (maskset read register): %d\n",
3098c2ecf20Sopenharmony_ci			err);
3108c2ecf20Sopenharmony_ci		goto get_maskset_unlock;
3118c2ecf20Sopenharmony_ci	} else if (err != 1) {
3128c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
3138c2ecf20Sopenharmony_ci			"write error (maskset read register)\n"
3148c2ecf20Sopenharmony_ci			"  %d bytes transferred (expected 1)\n",
3158c2ecf20Sopenharmony_ci			err);
3168c2ecf20Sopenharmony_ci		err = -EIO;
3178c2ecf20Sopenharmony_ci		goto get_maskset_unlock;
3188c2ecf20Sopenharmony_ci	}
3198c2ecf20Sopenharmony_ci
3208c2ecf20Sopenharmony_ci	/* Modify the register */
3218c2ecf20Sopenharmony_ci	regandval[1] &= andmask;
3228c2ecf20Sopenharmony_ci	regandval[1] |= ormask;
3238c2ecf20Sopenharmony_ci
3248c2ecf20Sopenharmony_ci	/* Write the register */
3258c2ecf20Sopenharmony_ci	err = i2c_master_send(ab3100->i2c_client, regandval, 2);
3268c2ecf20Sopenharmony_ci	if (err < 0) {
3278c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
3288c2ecf20Sopenharmony_ci			"write error (write register): %d\n",
3298c2ecf20Sopenharmony_ci			err);
3308c2ecf20Sopenharmony_ci		goto get_maskset_unlock;
3318c2ecf20Sopenharmony_ci	} else if (err != 2) {
3328c2ecf20Sopenharmony_ci		dev_err(ab3100->dev,
3338c2ecf20Sopenharmony_ci			"write error (write register)\n"
3348c2ecf20Sopenharmony_ci			"  %d bytes transferred (expected 2)\n",
3358c2ecf20Sopenharmony_ci			err);
3368c2ecf20Sopenharmony_ci		err = -EIO;
3378c2ecf20Sopenharmony_ci		goto get_maskset_unlock;
3388c2ecf20Sopenharmony_ci	}
3398c2ecf20Sopenharmony_ci
3408c2ecf20Sopenharmony_ci	/* All is well */
3418c2ecf20Sopenharmony_ci	err = 0;
3428c2ecf20Sopenharmony_ci
3438c2ecf20Sopenharmony_ci get_maskset_unlock:
3448c2ecf20Sopenharmony_ci	mutex_unlock(&ab3100->access_mutex);
3458c2ecf20Sopenharmony_ci	return err;
3468c2ecf20Sopenharmony_ci}
3478c2ecf20Sopenharmony_ci
3488c2ecf20Sopenharmony_cistatic int mask_and_set_register_interruptible(struct device *dev, u8 bank,
3498c2ecf20Sopenharmony_ci	u8 reg, u8 bitmask, u8 bitvalues)
3508c2ecf20Sopenharmony_ci{
3518c2ecf20Sopenharmony_ci	struct ab3100 *ab3100 = dev_get_drvdata(dev->parent);
3528c2ecf20Sopenharmony_ci
3538c2ecf20Sopenharmony_ci	return ab3100_mask_and_set_register_interruptible(ab3100,
3548c2ecf20Sopenharmony_ci			reg, bitmask, (bitmask & bitvalues));
3558c2ecf20Sopenharmony_ci}
3568c2ecf20Sopenharmony_ci
3578c2ecf20Sopenharmony_ci/*
3588c2ecf20Sopenharmony_ci * Register a simple callback for handling any AB3100 events.
3598c2ecf20Sopenharmony_ci */
3608c2ecf20Sopenharmony_ciint ab3100_event_register(struct ab3100 *ab3100,
3618c2ecf20Sopenharmony_ci			  struct notifier_block *nb)
3628c2ecf20Sopenharmony_ci{
3638c2ecf20Sopenharmony_ci	return blocking_notifier_chain_register(&ab3100->event_subscribers,
3648c2ecf20Sopenharmony_ci					       nb);
3658c2ecf20Sopenharmony_ci}
3668c2ecf20Sopenharmony_ciEXPORT_SYMBOL(ab3100_event_register);
3678c2ecf20Sopenharmony_ci
3688c2ecf20Sopenharmony_ci/*
3698c2ecf20Sopenharmony_ci * Remove a previously registered callback.
3708c2ecf20Sopenharmony_ci */
3718c2ecf20Sopenharmony_ciint ab3100_event_unregister(struct ab3100 *ab3100,
3728c2ecf20Sopenharmony_ci			    struct notifier_block *nb)
3738c2ecf20Sopenharmony_ci{
3748c2ecf20Sopenharmony_ci	return blocking_notifier_chain_unregister(&ab3100->event_subscribers,
3758c2ecf20Sopenharmony_ci					    nb);
3768c2ecf20Sopenharmony_ci}
3778c2ecf20Sopenharmony_ciEXPORT_SYMBOL(ab3100_event_unregister);
3788c2ecf20Sopenharmony_ci
3798c2ecf20Sopenharmony_ci
3808c2ecf20Sopenharmony_cistatic int ab3100_event_registers_startup_state_get(struct device *dev,
3818c2ecf20Sopenharmony_ci					     u8 *event)
3828c2ecf20Sopenharmony_ci{
3838c2ecf20Sopenharmony_ci	struct ab3100 *ab3100 = dev_get_drvdata(dev->parent);
3848c2ecf20Sopenharmony_ci
3858c2ecf20Sopenharmony_ci	if (!ab3100->startup_events_read)
3868c2ecf20Sopenharmony_ci		return -EAGAIN; /* Try again later */
3878c2ecf20Sopenharmony_ci	memcpy(event, ab3100->startup_events, 3);
3888c2ecf20Sopenharmony_ci
3898c2ecf20Sopenharmony_ci	return 0;
3908c2ecf20Sopenharmony_ci}
3918c2ecf20Sopenharmony_ci
3928c2ecf20Sopenharmony_cistatic struct abx500_ops ab3100_ops = {
3938c2ecf20Sopenharmony_ci	.get_chip_id = ab3100_get_chip_id,
3948c2ecf20Sopenharmony_ci	.set_register = set_register_interruptible,
3958c2ecf20Sopenharmony_ci	.get_register = get_register_interruptible,
3968c2ecf20Sopenharmony_ci	.get_register_page = get_register_page_interruptible,
3978c2ecf20Sopenharmony_ci	.set_register_page = NULL,
3988c2ecf20Sopenharmony_ci	.mask_and_set_register = mask_and_set_register_interruptible,
3998c2ecf20Sopenharmony_ci	.event_registers_startup_state_get =
4008c2ecf20Sopenharmony_ci		ab3100_event_registers_startup_state_get,
4018c2ecf20Sopenharmony_ci	.startup_irq_enabled = NULL,
4028c2ecf20Sopenharmony_ci};
4038c2ecf20Sopenharmony_ci
4048c2ecf20Sopenharmony_ci/*
4058c2ecf20Sopenharmony_ci * This is a threaded interrupt handler so we can make some
4068c2ecf20Sopenharmony_ci * I2C calls etc.
4078c2ecf20Sopenharmony_ci */
4088c2ecf20Sopenharmony_cistatic irqreturn_t ab3100_irq_handler(int irq, void *data)
4098c2ecf20Sopenharmony_ci{
4108c2ecf20Sopenharmony_ci	struct ab3100 *ab3100 = data;
4118c2ecf20Sopenharmony_ci	u8 event_regs[3];
4128c2ecf20Sopenharmony_ci	u32 fatevent;
4138c2ecf20Sopenharmony_ci	int err;
4148c2ecf20Sopenharmony_ci
4158c2ecf20Sopenharmony_ci	err = ab3100_get_register_page_interruptible(ab3100, AB3100_EVENTA1,
4168c2ecf20Sopenharmony_ci				       event_regs, 3);
4178c2ecf20Sopenharmony_ci	if (err)
4188c2ecf20Sopenharmony_ci		goto err_event;
4198c2ecf20Sopenharmony_ci
4208c2ecf20Sopenharmony_ci	fatevent = (event_regs[0] << 16) |
4218c2ecf20Sopenharmony_ci		(event_regs[1] << 8) |
4228c2ecf20Sopenharmony_ci		event_regs[2];
4238c2ecf20Sopenharmony_ci
4248c2ecf20Sopenharmony_ci	if (!ab3100->startup_events_read) {
4258c2ecf20Sopenharmony_ci		ab3100->startup_events[0] = event_regs[0];
4268c2ecf20Sopenharmony_ci		ab3100->startup_events[1] = event_regs[1];
4278c2ecf20Sopenharmony_ci		ab3100->startup_events[2] = event_regs[2];
4288c2ecf20Sopenharmony_ci		ab3100->startup_events_read = true;
4298c2ecf20Sopenharmony_ci	}
4308c2ecf20Sopenharmony_ci	/*
4318c2ecf20Sopenharmony_ci	 * The notified parties will have to mask out the events
4328c2ecf20Sopenharmony_ci	 * they're interested in and react to them. They will be
4338c2ecf20Sopenharmony_ci	 * notified on all events, then they use the fatevent value
4348c2ecf20Sopenharmony_ci	 * to determine if they're interested.
4358c2ecf20Sopenharmony_ci	 */
4368c2ecf20Sopenharmony_ci	blocking_notifier_call_chain(&ab3100->event_subscribers,
4378c2ecf20Sopenharmony_ci				     fatevent, NULL);
4388c2ecf20Sopenharmony_ci
4398c2ecf20Sopenharmony_ci	dev_dbg(ab3100->dev,
4408c2ecf20Sopenharmony_ci		"IRQ Event: 0x%08x\n", fatevent);
4418c2ecf20Sopenharmony_ci
4428c2ecf20Sopenharmony_ci	return IRQ_HANDLED;
4438c2ecf20Sopenharmony_ci
4448c2ecf20Sopenharmony_ci err_event:
4458c2ecf20Sopenharmony_ci	dev_dbg(ab3100->dev,
4468c2ecf20Sopenharmony_ci		"error reading event status\n");
4478c2ecf20Sopenharmony_ci	return IRQ_HANDLED;
4488c2ecf20Sopenharmony_ci}
4498c2ecf20Sopenharmony_ci
4508c2ecf20Sopenharmony_ci#ifdef CONFIG_DEBUG_FS
4518c2ecf20Sopenharmony_ci/*
4528c2ecf20Sopenharmony_ci * Some debugfs entries only exposed if we're using debug
4538c2ecf20Sopenharmony_ci */
4548c2ecf20Sopenharmony_cistatic int ab3100_registers_print(struct seq_file *s, void *p)
4558c2ecf20Sopenharmony_ci{
4568c2ecf20Sopenharmony_ci	struct ab3100 *ab3100 = s->private;
4578c2ecf20Sopenharmony_ci	u8 value;
4588c2ecf20Sopenharmony_ci	u8 reg;
4598c2ecf20Sopenharmony_ci
4608c2ecf20Sopenharmony_ci	seq_puts(s, "AB3100 registers:\n");
4618c2ecf20Sopenharmony_ci
4628c2ecf20Sopenharmony_ci	for (reg = 0; reg < 0xff; reg++) {
4638c2ecf20Sopenharmony_ci		ab3100_get_register_interruptible(ab3100, reg, &value);
4648c2ecf20Sopenharmony_ci		seq_printf(s, "[0x%x]:  0x%x\n", reg, value);
4658c2ecf20Sopenharmony_ci	}
4668c2ecf20Sopenharmony_ci	return 0;
4678c2ecf20Sopenharmony_ci}
4688c2ecf20Sopenharmony_ci
4698c2ecf20Sopenharmony_cistatic int ab3100_registers_open(struct inode *inode, struct file *file)
4708c2ecf20Sopenharmony_ci{
4718c2ecf20Sopenharmony_ci	return single_open(file, ab3100_registers_print, inode->i_private);
4728c2ecf20Sopenharmony_ci}
4738c2ecf20Sopenharmony_ci
4748c2ecf20Sopenharmony_cistatic const struct file_operations ab3100_registers_fops = {
4758c2ecf20Sopenharmony_ci	.open = ab3100_registers_open,
4768c2ecf20Sopenharmony_ci	.read = seq_read,
4778c2ecf20Sopenharmony_ci	.llseek = seq_lseek,
4788c2ecf20Sopenharmony_ci	.release = single_release,
4798c2ecf20Sopenharmony_ci	.owner = THIS_MODULE,
4808c2ecf20Sopenharmony_ci};
4818c2ecf20Sopenharmony_ci
4828c2ecf20Sopenharmony_cistruct ab3100_get_set_reg_priv {
4838c2ecf20Sopenharmony_ci	struct ab3100 *ab3100;
4848c2ecf20Sopenharmony_ci	bool mode;
4858c2ecf20Sopenharmony_ci};
4868c2ecf20Sopenharmony_ci
4878c2ecf20Sopenharmony_cistatic ssize_t ab3100_get_set_reg(struct file *file,
4888c2ecf20Sopenharmony_ci				  const char __user *user_buf,
4898c2ecf20Sopenharmony_ci				  size_t count, loff_t *ppos)
4908c2ecf20Sopenharmony_ci{
4918c2ecf20Sopenharmony_ci	struct ab3100_get_set_reg_priv *priv = file->private_data;
4928c2ecf20Sopenharmony_ci	struct ab3100 *ab3100 = priv->ab3100;
4938c2ecf20Sopenharmony_ci	char buf[32];
4948c2ecf20Sopenharmony_ci	ssize_t buf_size;
4958c2ecf20Sopenharmony_ci	int regp;
4968c2ecf20Sopenharmony_ci	u8 user_reg;
4978c2ecf20Sopenharmony_ci	int err;
4988c2ecf20Sopenharmony_ci	int i = 0;
4998c2ecf20Sopenharmony_ci
5008c2ecf20Sopenharmony_ci	/* Get userspace string and assure termination */
5018c2ecf20Sopenharmony_ci	buf_size = min((ssize_t)count, (ssize_t)(sizeof(buf)-1));
5028c2ecf20Sopenharmony_ci	if (copy_from_user(buf, user_buf, buf_size))
5038c2ecf20Sopenharmony_ci		return -EFAULT;
5048c2ecf20Sopenharmony_ci	buf[buf_size] = 0;
5058c2ecf20Sopenharmony_ci
5068c2ecf20Sopenharmony_ci	/*
5078c2ecf20Sopenharmony_ci	 * The idea is here to parse a string which is either
5088c2ecf20Sopenharmony_ci	 * "0xnn" for reading a register, or "0xaa 0xbb" for
5098c2ecf20Sopenharmony_ci	 * writing 0xbb to the register 0xaa. First move past
5108c2ecf20Sopenharmony_ci	 * whitespace and then begin to parse the register.
5118c2ecf20Sopenharmony_ci	 */
5128c2ecf20Sopenharmony_ci	while ((i < buf_size) && (buf[i] == ' '))
5138c2ecf20Sopenharmony_ci		i++;
5148c2ecf20Sopenharmony_ci	regp = i;
5158c2ecf20Sopenharmony_ci
5168c2ecf20Sopenharmony_ci	/*
5178c2ecf20Sopenharmony_ci	 * Advance pointer to end of string then terminate
5188c2ecf20Sopenharmony_ci	 * the register string. This is needed to satisfy
5198c2ecf20Sopenharmony_ci	 * the kstrtou8() function.
5208c2ecf20Sopenharmony_ci	 */
5218c2ecf20Sopenharmony_ci	while ((i < buf_size) && (buf[i] != ' '))
5228c2ecf20Sopenharmony_ci		i++;
5238c2ecf20Sopenharmony_ci	buf[i] = '\0';
5248c2ecf20Sopenharmony_ci
5258c2ecf20Sopenharmony_ci	err = kstrtou8(&buf[regp], 16, &user_reg);
5268c2ecf20Sopenharmony_ci	if (err)
5278c2ecf20Sopenharmony_ci		return err;
5288c2ecf20Sopenharmony_ci
5298c2ecf20Sopenharmony_ci	/* Either we read or we write a register here */
5308c2ecf20Sopenharmony_ci	if (!priv->mode) {
5318c2ecf20Sopenharmony_ci		/* Reading */
5328c2ecf20Sopenharmony_ci		u8 regvalue;
5338c2ecf20Sopenharmony_ci
5348c2ecf20Sopenharmony_ci		ab3100_get_register_interruptible(ab3100, user_reg, &regvalue);
5358c2ecf20Sopenharmony_ci
5368c2ecf20Sopenharmony_ci		dev_info(ab3100->dev,
5378c2ecf20Sopenharmony_ci			 "debug read AB3100 reg[0x%02x]: 0x%02x\n",
5388c2ecf20Sopenharmony_ci			 user_reg, regvalue);
5398c2ecf20Sopenharmony_ci	} else {
5408c2ecf20Sopenharmony_ci		int valp;
5418c2ecf20Sopenharmony_ci		u8 user_value;
5428c2ecf20Sopenharmony_ci		u8 regvalue;
5438c2ecf20Sopenharmony_ci
5448c2ecf20Sopenharmony_ci		/*
5458c2ecf20Sopenharmony_ci		 * Writing, we need some value to write to
5468c2ecf20Sopenharmony_ci		 * the register so keep parsing the string
5478c2ecf20Sopenharmony_ci		 * from userspace.
5488c2ecf20Sopenharmony_ci		 */
5498c2ecf20Sopenharmony_ci		i++;
5508c2ecf20Sopenharmony_ci		while ((i < buf_size) && (buf[i] == ' '))
5518c2ecf20Sopenharmony_ci			i++;
5528c2ecf20Sopenharmony_ci		valp = i;
5538c2ecf20Sopenharmony_ci		while ((i < buf_size) && (buf[i] != ' '))
5548c2ecf20Sopenharmony_ci			i++;
5558c2ecf20Sopenharmony_ci		buf[i] = '\0';
5568c2ecf20Sopenharmony_ci
5578c2ecf20Sopenharmony_ci		err = kstrtou8(&buf[valp], 16, &user_value);
5588c2ecf20Sopenharmony_ci		if (err)
5598c2ecf20Sopenharmony_ci			return err;
5608c2ecf20Sopenharmony_ci
5618c2ecf20Sopenharmony_ci		ab3100_set_register_interruptible(ab3100, user_reg, user_value);
5628c2ecf20Sopenharmony_ci		ab3100_get_register_interruptible(ab3100, user_reg, &regvalue);
5638c2ecf20Sopenharmony_ci
5648c2ecf20Sopenharmony_ci		dev_info(ab3100->dev,
5658c2ecf20Sopenharmony_ci			 "debug write reg[0x%02x]\n"
5668c2ecf20Sopenharmony_ci			 "  with 0x%02x, after readback: 0x%02x\n",
5678c2ecf20Sopenharmony_ci			 user_reg, user_value, regvalue);
5688c2ecf20Sopenharmony_ci	}
5698c2ecf20Sopenharmony_ci	return buf_size;
5708c2ecf20Sopenharmony_ci}
5718c2ecf20Sopenharmony_ci
5728c2ecf20Sopenharmony_cistatic const struct file_operations ab3100_get_set_reg_fops = {
5738c2ecf20Sopenharmony_ci	.open = simple_open,
5748c2ecf20Sopenharmony_ci	.write = ab3100_get_set_reg,
5758c2ecf20Sopenharmony_ci	.llseek = noop_llseek,
5768c2ecf20Sopenharmony_ci};
5778c2ecf20Sopenharmony_ci
5788c2ecf20Sopenharmony_cistatic struct ab3100_get_set_reg_priv ab3100_get_priv;
5798c2ecf20Sopenharmony_cistatic struct ab3100_get_set_reg_priv ab3100_set_priv;
5808c2ecf20Sopenharmony_ci
5818c2ecf20Sopenharmony_cistatic void ab3100_setup_debugfs(struct ab3100 *ab3100)
5828c2ecf20Sopenharmony_ci{
5838c2ecf20Sopenharmony_ci	struct dentry *ab3100_dir;
5848c2ecf20Sopenharmony_ci
5858c2ecf20Sopenharmony_ci	ab3100_dir = debugfs_create_dir("ab3100", NULL);
5868c2ecf20Sopenharmony_ci
5878c2ecf20Sopenharmony_ci	debugfs_create_file("registers", S_IRUGO, ab3100_dir, ab3100,
5888c2ecf20Sopenharmony_ci			    &ab3100_registers_fops);
5898c2ecf20Sopenharmony_ci
5908c2ecf20Sopenharmony_ci	ab3100_get_priv.ab3100 = ab3100;
5918c2ecf20Sopenharmony_ci	ab3100_get_priv.mode = false;
5928c2ecf20Sopenharmony_ci	debugfs_create_file("get_reg", S_IWUSR, ab3100_dir, &ab3100_get_priv,
5938c2ecf20Sopenharmony_ci			    &ab3100_get_set_reg_fops);
5948c2ecf20Sopenharmony_ci
5958c2ecf20Sopenharmony_ci	ab3100_set_priv.ab3100 = ab3100;
5968c2ecf20Sopenharmony_ci	ab3100_set_priv.mode = true;
5978c2ecf20Sopenharmony_ci	debugfs_create_file("set_reg", S_IWUSR, ab3100_dir, &ab3100_set_priv,
5988c2ecf20Sopenharmony_ci			    &ab3100_get_set_reg_fops);
5998c2ecf20Sopenharmony_ci}
6008c2ecf20Sopenharmony_ci#else
6018c2ecf20Sopenharmony_cistatic inline void ab3100_setup_debugfs(struct ab3100 *ab3100)
6028c2ecf20Sopenharmony_ci{
6038c2ecf20Sopenharmony_ci}
6048c2ecf20Sopenharmony_ci#endif
6058c2ecf20Sopenharmony_ci
6068c2ecf20Sopenharmony_ci/*
6078c2ecf20Sopenharmony_ci * Basic set-up, datastructure creation/destruction and I2C interface.
6088c2ecf20Sopenharmony_ci * This sets up a default config in the AB3100 chip so that it
6098c2ecf20Sopenharmony_ci * will work as expected.
6108c2ecf20Sopenharmony_ci */
6118c2ecf20Sopenharmony_ci
6128c2ecf20Sopenharmony_cistruct ab3100_init_setting {
6138c2ecf20Sopenharmony_ci	u8 abreg;
6148c2ecf20Sopenharmony_ci	u8 setting;
6158c2ecf20Sopenharmony_ci};
6168c2ecf20Sopenharmony_ci
6178c2ecf20Sopenharmony_cistatic const struct ab3100_init_setting ab3100_init_settings[] = {
6188c2ecf20Sopenharmony_ci	{
6198c2ecf20Sopenharmony_ci		.abreg = AB3100_MCA,
6208c2ecf20Sopenharmony_ci		.setting = 0x01
6218c2ecf20Sopenharmony_ci	}, {
6228c2ecf20Sopenharmony_ci		.abreg = AB3100_MCB,
6238c2ecf20Sopenharmony_ci		.setting = 0x30
6248c2ecf20Sopenharmony_ci	}, {
6258c2ecf20Sopenharmony_ci		.abreg = AB3100_IMRA1,
6268c2ecf20Sopenharmony_ci		.setting = 0x00
6278c2ecf20Sopenharmony_ci	}, {
6288c2ecf20Sopenharmony_ci		.abreg = AB3100_IMRA2,
6298c2ecf20Sopenharmony_ci		.setting = 0xFF
6308c2ecf20Sopenharmony_ci	}, {
6318c2ecf20Sopenharmony_ci		.abreg = AB3100_IMRA3,
6328c2ecf20Sopenharmony_ci		.setting = 0x01
6338c2ecf20Sopenharmony_ci	}, {
6348c2ecf20Sopenharmony_ci		.abreg = AB3100_IMRB1,
6358c2ecf20Sopenharmony_ci		.setting = 0xBF
6368c2ecf20Sopenharmony_ci	}, {
6378c2ecf20Sopenharmony_ci		.abreg = AB3100_IMRB2,
6388c2ecf20Sopenharmony_ci		.setting = 0xFF
6398c2ecf20Sopenharmony_ci	}, {
6408c2ecf20Sopenharmony_ci		.abreg = AB3100_IMRB3,
6418c2ecf20Sopenharmony_ci		.setting = 0xFF
6428c2ecf20Sopenharmony_ci	}, {
6438c2ecf20Sopenharmony_ci		.abreg = AB3100_SUP,
6448c2ecf20Sopenharmony_ci		.setting = 0x00
6458c2ecf20Sopenharmony_ci	}, {
6468c2ecf20Sopenharmony_ci		.abreg = AB3100_DIS,
6478c2ecf20Sopenharmony_ci		.setting = 0xF0
6488c2ecf20Sopenharmony_ci	}, {
6498c2ecf20Sopenharmony_ci		.abreg = AB3100_D0C,
6508c2ecf20Sopenharmony_ci		.setting = 0x00
6518c2ecf20Sopenharmony_ci	}, {
6528c2ecf20Sopenharmony_ci		.abreg = AB3100_D1C,
6538c2ecf20Sopenharmony_ci		.setting = 0x00
6548c2ecf20Sopenharmony_ci	}, {
6558c2ecf20Sopenharmony_ci		.abreg = AB3100_D2C,
6568c2ecf20Sopenharmony_ci		.setting = 0x00
6578c2ecf20Sopenharmony_ci	}, {
6588c2ecf20Sopenharmony_ci		.abreg = AB3100_D3C,
6598c2ecf20Sopenharmony_ci		.setting = 0x00
6608c2ecf20Sopenharmony_ci	},
6618c2ecf20Sopenharmony_ci};
6628c2ecf20Sopenharmony_ci
6638c2ecf20Sopenharmony_cistatic int ab3100_setup(struct ab3100 *ab3100)
6648c2ecf20Sopenharmony_ci{
6658c2ecf20Sopenharmony_ci	int err = 0;
6668c2ecf20Sopenharmony_ci	int i;
6678c2ecf20Sopenharmony_ci
6688c2ecf20Sopenharmony_ci	for (i = 0; i < ARRAY_SIZE(ab3100_init_settings); i++) {
6698c2ecf20Sopenharmony_ci		err = ab3100_set_register_interruptible(ab3100,
6708c2ecf20Sopenharmony_ci					  ab3100_init_settings[i].abreg,
6718c2ecf20Sopenharmony_ci					  ab3100_init_settings[i].setting);
6728c2ecf20Sopenharmony_ci		if (err)
6738c2ecf20Sopenharmony_ci			goto exit_no_setup;
6748c2ecf20Sopenharmony_ci	}
6758c2ecf20Sopenharmony_ci
6768c2ecf20Sopenharmony_ci	/*
6778c2ecf20Sopenharmony_ci	 * Special trick to make the AB3100 use the 32kHz clock (RTC)
6788c2ecf20Sopenharmony_ci	 * bit 3 in test register 0x02 is a special, undocumented test
6798c2ecf20Sopenharmony_ci	 * register bit that only exist in AB3100 P1E
6808c2ecf20Sopenharmony_ci	 */
6818c2ecf20Sopenharmony_ci	if (ab3100->chip_id == 0xc4) {
6828c2ecf20Sopenharmony_ci		dev_warn(ab3100->dev,
6838c2ecf20Sopenharmony_ci			 "AB3100 P1E variant detected forcing chip to 32KHz\n");
6848c2ecf20Sopenharmony_ci		err = ab3100_set_test_register_interruptible(ab3100,
6858c2ecf20Sopenharmony_ci			0x02, 0x08);
6868c2ecf20Sopenharmony_ci	}
6878c2ecf20Sopenharmony_ci
6888c2ecf20Sopenharmony_ci exit_no_setup:
6898c2ecf20Sopenharmony_ci	return err;
6908c2ecf20Sopenharmony_ci}
6918c2ecf20Sopenharmony_ci
6928c2ecf20Sopenharmony_ci/* The subdevices of the AB3100 */
6938c2ecf20Sopenharmony_cistatic struct mfd_cell ab3100_devs[] = {
6948c2ecf20Sopenharmony_ci	{
6958c2ecf20Sopenharmony_ci		.name = "ab3100-dac",
6968c2ecf20Sopenharmony_ci		.id = -1,
6978c2ecf20Sopenharmony_ci	},
6988c2ecf20Sopenharmony_ci	{
6998c2ecf20Sopenharmony_ci		.name = "ab3100-leds",
7008c2ecf20Sopenharmony_ci		.id = -1,
7018c2ecf20Sopenharmony_ci	},
7028c2ecf20Sopenharmony_ci	{
7038c2ecf20Sopenharmony_ci		.name = "ab3100-power",
7048c2ecf20Sopenharmony_ci		.id = -1,
7058c2ecf20Sopenharmony_ci	},
7068c2ecf20Sopenharmony_ci	{
7078c2ecf20Sopenharmony_ci		.name = "ab3100-regulators",
7088c2ecf20Sopenharmony_ci		.of_compatible = "stericsson,ab3100-regulators",
7098c2ecf20Sopenharmony_ci		.id = -1,
7108c2ecf20Sopenharmony_ci	},
7118c2ecf20Sopenharmony_ci	{
7128c2ecf20Sopenharmony_ci		.name = "ab3100-sim",
7138c2ecf20Sopenharmony_ci		.id = -1,
7148c2ecf20Sopenharmony_ci	},
7158c2ecf20Sopenharmony_ci	{
7168c2ecf20Sopenharmony_ci		.name = "ab3100-uart",
7178c2ecf20Sopenharmony_ci		.id = -1,
7188c2ecf20Sopenharmony_ci	},
7198c2ecf20Sopenharmony_ci	{
7208c2ecf20Sopenharmony_ci		.name = "ab3100-rtc",
7218c2ecf20Sopenharmony_ci		.id = -1,
7228c2ecf20Sopenharmony_ci	},
7238c2ecf20Sopenharmony_ci	{
7248c2ecf20Sopenharmony_ci		.name = "ab3100-charger",
7258c2ecf20Sopenharmony_ci		.id = -1,
7268c2ecf20Sopenharmony_ci	},
7278c2ecf20Sopenharmony_ci	{
7288c2ecf20Sopenharmony_ci		.name = "ab3100-boost",
7298c2ecf20Sopenharmony_ci		.id = -1,
7308c2ecf20Sopenharmony_ci	},
7318c2ecf20Sopenharmony_ci	{
7328c2ecf20Sopenharmony_ci		.name = "ab3100-adc",
7338c2ecf20Sopenharmony_ci		.id = -1,
7348c2ecf20Sopenharmony_ci	},
7358c2ecf20Sopenharmony_ci	{
7368c2ecf20Sopenharmony_ci		.name = "ab3100-fuelgauge",
7378c2ecf20Sopenharmony_ci		.id = -1,
7388c2ecf20Sopenharmony_ci	},
7398c2ecf20Sopenharmony_ci	{
7408c2ecf20Sopenharmony_ci		.name = "ab3100-vibrator",
7418c2ecf20Sopenharmony_ci		.id = -1,
7428c2ecf20Sopenharmony_ci	},
7438c2ecf20Sopenharmony_ci	{
7448c2ecf20Sopenharmony_ci		.name = "ab3100-otp",
7458c2ecf20Sopenharmony_ci		.id = -1,
7468c2ecf20Sopenharmony_ci	},
7478c2ecf20Sopenharmony_ci	{
7488c2ecf20Sopenharmony_ci		.name = "ab3100-codec",
7498c2ecf20Sopenharmony_ci		.id = -1,
7508c2ecf20Sopenharmony_ci	},
7518c2ecf20Sopenharmony_ci};
7528c2ecf20Sopenharmony_ci
7538c2ecf20Sopenharmony_cistruct ab_family_id {
7548c2ecf20Sopenharmony_ci	u8	id;
7558c2ecf20Sopenharmony_ci	char	*name;
7568c2ecf20Sopenharmony_ci};
7578c2ecf20Sopenharmony_ci
7588c2ecf20Sopenharmony_cistatic const struct ab_family_id ids[] = {
7598c2ecf20Sopenharmony_ci	/* AB3100 */
7608c2ecf20Sopenharmony_ci	{
7618c2ecf20Sopenharmony_ci		.id = 0xc0,
7628c2ecf20Sopenharmony_ci		.name = "P1A"
7638c2ecf20Sopenharmony_ci	}, {
7648c2ecf20Sopenharmony_ci		.id = 0xc1,
7658c2ecf20Sopenharmony_ci		.name = "P1B"
7668c2ecf20Sopenharmony_ci	}, {
7678c2ecf20Sopenharmony_ci		.id = 0xc2,
7688c2ecf20Sopenharmony_ci		.name = "P1C"
7698c2ecf20Sopenharmony_ci	}, {
7708c2ecf20Sopenharmony_ci		.id = 0xc3,
7718c2ecf20Sopenharmony_ci		.name = "P1D"
7728c2ecf20Sopenharmony_ci	}, {
7738c2ecf20Sopenharmony_ci		.id = 0xc4,
7748c2ecf20Sopenharmony_ci		.name = "P1E"
7758c2ecf20Sopenharmony_ci	}, {
7768c2ecf20Sopenharmony_ci		.id = 0xc5,
7778c2ecf20Sopenharmony_ci		.name = "P1F/R1A"
7788c2ecf20Sopenharmony_ci	}, {
7798c2ecf20Sopenharmony_ci		.id = 0xc6,
7808c2ecf20Sopenharmony_ci		.name = "P1G/R1A"
7818c2ecf20Sopenharmony_ci	}, {
7828c2ecf20Sopenharmony_ci		.id = 0xc7,
7838c2ecf20Sopenharmony_ci		.name = "P2A/R2A"
7848c2ecf20Sopenharmony_ci	}, {
7858c2ecf20Sopenharmony_ci		.id = 0xc8,
7868c2ecf20Sopenharmony_ci		.name = "P2B/R2B"
7878c2ecf20Sopenharmony_ci	},
7888c2ecf20Sopenharmony_ci	/* AB3000 variants, not supported */
7898c2ecf20Sopenharmony_ci	{
7908c2ecf20Sopenharmony_ci		.id = 0xa0
7918c2ecf20Sopenharmony_ci	}, {
7928c2ecf20Sopenharmony_ci		.id = 0xa1
7938c2ecf20Sopenharmony_ci	}, {
7948c2ecf20Sopenharmony_ci		.id = 0xa2
7958c2ecf20Sopenharmony_ci	}, {
7968c2ecf20Sopenharmony_ci		.id = 0xa3
7978c2ecf20Sopenharmony_ci	}, {
7988c2ecf20Sopenharmony_ci		.id = 0xa4
7998c2ecf20Sopenharmony_ci	}, {
8008c2ecf20Sopenharmony_ci		.id = 0xa5
8018c2ecf20Sopenharmony_ci	}, {
8028c2ecf20Sopenharmony_ci		.id = 0xa6
8038c2ecf20Sopenharmony_ci	}, {
8048c2ecf20Sopenharmony_ci		.id = 0xa7
8058c2ecf20Sopenharmony_ci	},
8068c2ecf20Sopenharmony_ci	/* Terminator */
8078c2ecf20Sopenharmony_ci	{
8088c2ecf20Sopenharmony_ci		.id = 0x00,
8098c2ecf20Sopenharmony_ci	},
8108c2ecf20Sopenharmony_ci};
8118c2ecf20Sopenharmony_ci
8128c2ecf20Sopenharmony_cistatic int ab3100_probe(struct i2c_client *client,
8138c2ecf20Sopenharmony_ci				  const struct i2c_device_id *id)
8148c2ecf20Sopenharmony_ci{
8158c2ecf20Sopenharmony_ci	struct ab3100 *ab3100;
8168c2ecf20Sopenharmony_ci	struct ab3100_platform_data *ab3100_plf_data =
8178c2ecf20Sopenharmony_ci		dev_get_platdata(&client->dev);
8188c2ecf20Sopenharmony_ci	int err;
8198c2ecf20Sopenharmony_ci	int i;
8208c2ecf20Sopenharmony_ci
8218c2ecf20Sopenharmony_ci	ab3100 = devm_kzalloc(&client->dev, sizeof(struct ab3100), GFP_KERNEL);
8228c2ecf20Sopenharmony_ci	if (!ab3100)
8238c2ecf20Sopenharmony_ci		return -ENOMEM;
8248c2ecf20Sopenharmony_ci
8258c2ecf20Sopenharmony_ci	/* Initialize data structure */
8268c2ecf20Sopenharmony_ci	mutex_init(&ab3100->access_mutex);
8278c2ecf20Sopenharmony_ci	BLOCKING_INIT_NOTIFIER_HEAD(&ab3100->event_subscribers);
8288c2ecf20Sopenharmony_ci
8298c2ecf20Sopenharmony_ci	ab3100->i2c_client = client;
8308c2ecf20Sopenharmony_ci	ab3100->dev = &ab3100->i2c_client->dev;
8318c2ecf20Sopenharmony_ci
8328c2ecf20Sopenharmony_ci	i2c_set_clientdata(client, ab3100);
8338c2ecf20Sopenharmony_ci
8348c2ecf20Sopenharmony_ci	/* Read chip ID register */
8358c2ecf20Sopenharmony_ci	err = ab3100_get_register_interruptible(ab3100, AB3100_CID,
8368c2ecf20Sopenharmony_ci						&ab3100->chip_id);
8378c2ecf20Sopenharmony_ci	if (err) {
8388c2ecf20Sopenharmony_ci		dev_err(&client->dev,
8398c2ecf20Sopenharmony_ci			"failed to communicate with AB3100 chip\n");
8408c2ecf20Sopenharmony_ci		goto exit_no_detect;
8418c2ecf20Sopenharmony_ci	}
8428c2ecf20Sopenharmony_ci
8438c2ecf20Sopenharmony_ci	for (i = 0; ids[i].id != 0x0; i++) {
8448c2ecf20Sopenharmony_ci		if (ids[i].id == ab3100->chip_id) {
8458c2ecf20Sopenharmony_ci			if (ids[i].name)
8468c2ecf20Sopenharmony_ci				break;
8478c2ecf20Sopenharmony_ci
8488c2ecf20Sopenharmony_ci			dev_err(&client->dev, "AB3000 is not supported\n");
8498c2ecf20Sopenharmony_ci			goto exit_no_detect;
8508c2ecf20Sopenharmony_ci		}
8518c2ecf20Sopenharmony_ci	}
8528c2ecf20Sopenharmony_ci
8538c2ecf20Sopenharmony_ci	snprintf(&ab3100->chip_name[0],
8548c2ecf20Sopenharmony_ci		 sizeof(ab3100->chip_name) - 1, "AB3100 %s", ids[i].name);
8558c2ecf20Sopenharmony_ci
8568c2ecf20Sopenharmony_ci	if (ids[i].id == 0x0) {
8578c2ecf20Sopenharmony_ci		dev_err(&client->dev, "unknown analog baseband chip id: 0x%x\n",
8588c2ecf20Sopenharmony_ci			ab3100->chip_id);
8598c2ecf20Sopenharmony_ci		dev_err(&client->dev,
8608c2ecf20Sopenharmony_ci			"accepting it anyway. Please update the driver.\n");
8618c2ecf20Sopenharmony_ci		goto exit_no_detect;
8628c2ecf20Sopenharmony_ci	}
8638c2ecf20Sopenharmony_ci
8648c2ecf20Sopenharmony_ci	dev_info(&client->dev, "Detected chip: %s\n",
8658c2ecf20Sopenharmony_ci		 &ab3100->chip_name[0]);
8668c2ecf20Sopenharmony_ci
8678c2ecf20Sopenharmony_ci	/* Attach a second dummy i2c_client to the test register address */
8688c2ecf20Sopenharmony_ci	ab3100->testreg_client = i2c_new_dummy_device(client->adapter,
8698c2ecf20Sopenharmony_ci					       client->addr + 1);
8708c2ecf20Sopenharmony_ci	if (IS_ERR(ab3100->testreg_client)) {
8718c2ecf20Sopenharmony_ci		err = PTR_ERR(ab3100->testreg_client);
8728c2ecf20Sopenharmony_ci		goto exit_no_testreg_client;
8738c2ecf20Sopenharmony_ci	}
8748c2ecf20Sopenharmony_ci
8758c2ecf20Sopenharmony_ci	err = ab3100_setup(ab3100);
8768c2ecf20Sopenharmony_ci	if (err)
8778c2ecf20Sopenharmony_ci		goto exit_no_setup;
8788c2ecf20Sopenharmony_ci
8798c2ecf20Sopenharmony_ci	err = devm_request_threaded_irq(&client->dev,
8808c2ecf20Sopenharmony_ci					client->irq, NULL, ab3100_irq_handler,
8818c2ecf20Sopenharmony_ci					IRQF_ONESHOT, "ab3100-core", ab3100);
8828c2ecf20Sopenharmony_ci	if (err)
8838c2ecf20Sopenharmony_ci		goto exit_no_irq;
8848c2ecf20Sopenharmony_ci
8858c2ecf20Sopenharmony_ci	err = abx500_register_ops(&client->dev, &ab3100_ops);
8868c2ecf20Sopenharmony_ci	if (err)
8878c2ecf20Sopenharmony_ci		goto exit_no_ops;
8888c2ecf20Sopenharmony_ci
8898c2ecf20Sopenharmony_ci	/* Set up and register the platform devices. */
8908c2ecf20Sopenharmony_ci	for (i = 0; i < ARRAY_SIZE(ab3100_devs); i++) {
8918c2ecf20Sopenharmony_ci		ab3100_devs[i].platform_data = ab3100_plf_data;
8928c2ecf20Sopenharmony_ci		ab3100_devs[i].pdata_size = sizeof(struct ab3100_platform_data);
8938c2ecf20Sopenharmony_ci	}
8948c2ecf20Sopenharmony_ci
8958c2ecf20Sopenharmony_ci	err = mfd_add_devices(&client->dev, 0, ab3100_devs,
8968c2ecf20Sopenharmony_ci			      ARRAY_SIZE(ab3100_devs), NULL, 0, NULL);
8978c2ecf20Sopenharmony_ci
8988c2ecf20Sopenharmony_ci	ab3100_setup_debugfs(ab3100);
8998c2ecf20Sopenharmony_ci
9008c2ecf20Sopenharmony_ci	return 0;
9018c2ecf20Sopenharmony_ci
9028c2ecf20Sopenharmony_ci exit_no_ops:
9038c2ecf20Sopenharmony_ci exit_no_irq:
9048c2ecf20Sopenharmony_ci exit_no_setup:
9058c2ecf20Sopenharmony_ci	i2c_unregister_device(ab3100->testreg_client);
9068c2ecf20Sopenharmony_ci exit_no_testreg_client:
9078c2ecf20Sopenharmony_ci exit_no_detect:
9088c2ecf20Sopenharmony_ci	return err;
9098c2ecf20Sopenharmony_ci}
9108c2ecf20Sopenharmony_ci
9118c2ecf20Sopenharmony_cistatic const struct i2c_device_id ab3100_id[] = {
9128c2ecf20Sopenharmony_ci	{ "ab3100", 0 },
9138c2ecf20Sopenharmony_ci	{ }
9148c2ecf20Sopenharmony_ci};
9158c2ecf20Sopenharmony_ci
9168c2ecf20Sopenharmony_cistatic struct i2c_driver ab3100_driver = {
9178c2ecf20Sopenharmony_ci	.driver = {
9188c2ecf20Sopenharmony_ci		.name			= "ab3100",
9198c2ecf20Sopenharmony_ci		.suppress_bind_attrs	= true,
9208c2ecf20Sopenharmony_ci	},
9218c2ecf20Sopenharmony_ci	.id_table	= ab3100_id,
9228c2ecf20Sopenharmony_ci	.probe		= ab3100_probe,
9238c2ecf20Sopenharmony_ci};
9248c2ecf20Sopenharmony_ci
9258c2ecf20Sopenharmony_cistatic int __init ab3100_i2c_init(void)
9268c2ecf20Sopenharmony_ci{
9278c2ecf20Sopenharmony_ci	return i2c_add_driver(&ab3100_driver);
9288c2ecf20Sopenharmony_ci}
9298c2ecf20Sopenharmony_cisubsys_initcall(ab3100_i2c_init);
930