cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

stmpe-i2c.c (3708B)

      1// SPDX-License-Identifier: GPL-2.0-only
      2/*
      3 * ST Microelectronics MFD: stmpe's i2c client specific driver
      4 *
      5 * Copyright (C) ST-Ericsson SA 2010
      6 * Copyright (C) ST Microelectronics SA 2011
      7 *
      8 * Author: Rabin Vincent <rabin.vincent@stericsson.com> for ST-Ericsson
      9 * Author: Viresh Kumar <vireshk@kernel.org> for ST Microelectronics
     10 */
     11
     12#include <linux/i2c.h>
     13#include <linux/interrupt.h>
     14#include <linux/kernel.h>
     15#include <linux/module.h>
     16#include <linux/types.h>
     17#include <linux/of_device.h>
     18#include "stmpe.h"
     19
     20static int i2c_reg_read(struct stmpe *stmpe, u8 reg)
     21{
     22	struct i2c_client *i2c = stmpe->client;
     23
     24	return i2c_smbus_read_byte_data(i2c, reg);
     25}
     26
     27static int i2c_reg_write(struct stmpe *stmpe, u8 reg, u8 val)
     28{
     29	struct i2c_client *i2c = stmpe->client;
     30
     31	return i2c_smbus_write_byte_data(i2c, reg, val);
     32}
     33
     34static int i2c_block_read(struct stmpe *stmpe, u8 reg, u8 length, u8 *values)
     35{
     36	struct i2c_client *i2c = stmpe->client;
     37
     38	return i2c_smbus_read_i2c_block_data(i2c, reg, length, values);
     39}
     40
     41static int i2c_block_write(struct stmpe *stmpe, u8 reg, u8 length,
     42		const u8 *values)
     43{
     44	struct i2c_client *i2c = stmpe->client;
     45
     46	return i2c_smbus_write_i2c_block_data(i2c, reg, length, values);
     47}
     48
     49static struct stmpe_client_info i2c_ci = {
     50	.read_byte = i2c_reg_read,
     51	.write_byte = i2c_reg_write,
     52	.read_block = i2c_block_read,
     53	.write_block = i2c_block_write,
     54};
     55
     56static const struct of_device_id stmpe_of_match[] = {
     57	{ .compatible = "st,stmpe610", .data = (void *)STMPE610, },
     58	{ .compatible = "st,stmpe801", .data = (void *)STMPE801, },
     59	{ .compatible = "st,stmpe811", .data = (void *)STMPE811, },
     60	{ .compatible = "st,stmpe1600", .data = (void *)STMPE1600, },
     61	{ .compatible = "st,stmpe1601", .data = (void *)STMPE1601, },
     62	{ .compatible = "st,stmpe1801", .data = (void *)STMPE1801, },
     63	{ .compatible = "st,stmpe2401", .data = (void *)STMPE2401, },
     64	{ .compatible = "st,stmpe2403", .data = (void *)STMPE2403, },
     65	{},
     66};
     67MODULE_DEVICE_TABLE(of, stmpe_of_match);
     68
     69static int
     70stmpe_i2c_probe(struct i2c_client *i2c, const struct i2c_device_id *id)
     71{
     72	enum stmpe_partnum partnum;
     73	const struct of_device_id *of_id;
     74
     75	i2c_ci.data = (void *)id;
     76	i2c_ci.irq = i2c->irq;
     77	i2c_ci.client = i2c;
     78	i2c_ci.dev = &i2c->dev;
     79
     80	of_id = of_match_device(stmpe_of_match, &i2c->dev);
     81	if (!of_id) {
     82		/*
     83		 * This happens when the I2C ID matches the node name
     84		 * but no real compatible string has been given.
     85		 */
     86		dev_info(&i2c->dev, "matching on node name, compatible is preferred\n");
     87		partnum = id->driver_data;
     88	} else
     89		partnum = (enum stmpe_partnum)of_id->data;
     90
     91	return stmpe_probe(&i2c_ci, partnum);
     92}
     93
     94static int stmpe_i2c_remove(struct i2c_client *i2c)
     95{
     96	struct stmpe *stmpe = dev_get_drvdata(&i2c->dev);
     97
     98	stmpe_remove(stmpe);
     99
    100	return 0;
    101}
    102
    103static const struct i2c_device_id stmpe_i2c_id[] = {
    104	{ "stmpe610", STMPE610 },
    105	{ "stmpe801", STMPE801 },
    106	{ "stmpe811", STMPE811 },
    107	{ "stmpe1600", STMPE1600 },
    108	{ "stmpe1601", STMPE1601 },
    109	{ "stmpe1801", STMPE1801 },
    110	{ "stmpe2401", STMPE2401 },
    111	{ "stmpe2403", STMPE2403 },
    112	{ }
    113};
    114MODULE_DEVICE_TABLE(i2c, stmpe_i2c_id);
    115
    116static struct i2c_driver stmpe_i2c_driver = {
    117	.driver = {
    118		.name = "stmpe-i2c",
    119#ifdef CONFIG_PM
    120		.pm = &stmpe_dev_pm_ops,
    121#endif
    122		.of_match_table = stmpe_of_match,
    123	},
    124	.probe		= stmpe_i2c_probe,
    125	.remove		= stmpe_i2c_remove,
    126	.id_table	= stmpe_i2c_id,
    127};
    128
    129static int __init stmpe_init(void)
    130{
    131	return i2c_add_driver(&stmpe_i2c_driver);
    132}
    133subsys_initcall(stmpe_init);
    134
    135static void __exit stmpe_exit(void)
    136{
    137	i2c_del_driver(&stmpe_i2c_driver);
    138}
    139module_exit(stmpe_exit);
    140
    141MODULE_LICENSE("GPL v2");
    142MODULE_DESCRIPTION("STMPE MFD I2C Interface Driver");
    143MODULE_AUTHOR("Rabin Vincent <rabin.vincent@stericsson.com>");