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

cma3000_d0x_i2c.c (2628B)

      1// SPDX-License-Identifier: GPL-2.0-only
      2/*
      3 * Implements I2C interface for VTI CMA300_D0x Accelerometer driver
      4 *
      5 * Copyright (C) 2010 Texas Instruments
      6 * Author: Hemanth V <hemanthv@ti.com>
      7 */
      8
      9#include <linux/module.h>
     10#include <linux/i2c.h>
     11#include <linux/input/cma3000.h>
     12#include "cma3000_d0x.h"
     13
     14static int cma3000_i2c_set(struct device *dev,
     15			   u8 reg, u8 val, char *msg)
     16{
     17	struct i2c_client *client = to_i2c_client(dev);
     18	int ret;
     19
     20	ret = i2c_smbus_write_byte_data(client, reg, val);
     21	if (ret < 0)
     22		dev_err(&client->dev,
     23			"%s failed (%s, %d)\n", __func__, msg, ret);
     24	return ret;
     25}
     26
     27static int cma3000_i2c_read(struct device *dev, u8 reg, char *msg)
     28{
     29	struct i2c_client *client = to_i2c_client(dev);
     30	int ret;
     31
     32	ret = i2c_smbus_read_byte_data(client, reg);
     33	if (ret < 0)
     34		dev_err(&client->dev,
     35			"%s failed (%s, %d)\n", __func__, msg, ret);
     36	return ret;
     37}
     38
     39static const struct cma3000_bus_ops cma3000_i2c_bops = {
     40	.bustype	= BUS_I2C,
     41#define CMA3000_BUSI2C     (0 << 4)
     42	.ctrl_mod	= CMA3000_BUSI2C,
     43	.read		= cma3000_i2c_read,
     44	.write		= cma3000_i2c_set,
     45};
     46
     47static int cma3000_i2c_probe(struct i2c_client *client,
     48					const struct i2c_device_id *id)
     49{
     50	struct cma3000_accl_data *data;
     51
     52	data = cma3000_init(&client->dev, client->irq, &cma3000_i2c_bops);
     53	if (IS_ERR(data))
     54		return PTR_ERR(data);
     55
     56	i2c_set_clientdata(client, data);
     57
     58	return 0;
     59}
     60
     61static int cma3000_i2c_remove(struct i2c_client *client)
     62{
     63	struct cma3000_accl_data *data = i2c_get_clientdata(client);
     64
     65	cma3000_exit(data);
     66
     67	return 0;
     68}
     69
     70#ifdef CONFIG_PM
     71static int cma3000_i2c_suspend(struct device *dev)
     72{
     73	struct i2c_client *client = to_i2c_client(dev);
     74	struct cma3000_accl_data *data = i2c_get_clientdata(client);
     75
     76	cma3000_suspend(data);
     77
     78	return 0;
     79}
     80
     81static int cma3000_i2c_resume(struct device *dev)
     82{
     83	struct i2c_client *client = to_i2c_client(dev);
     84	struct cma3000_accl_data *data = i2c_get_clientdata(client);
     85
     86	cma3000_resume(data);
     87
     88	return 0;
     89}
     90
     91static const struct dev_pm_ops cma3000_i2c_pm_ops = {
     92	.suspend	= cma3000_i2c_suspend,
     93	.resume		= cma3000_i2c_resume,
     94};
     95#endif
     96
     97static const struct i2c_device_id cma3000_i2c_id[] = {
     98	{ "cma3000_d01", 0 },
     99	{ },
    100};
    101
    102MODULE_DEVICE_TABLE(i2c, cma3000_i2c_id);
    103
    104static struct i2c_driver cma3000_i2c_driver = {
    105	.probe		= cma3000_i2c_probe,
    106	.remove		= cma3000_i2c_remove,
    107	.id_table	= cma3000_i2c_id,
    108	.driver = {
    109		.name	= "cma3000_i2c_accl",
    110#ifdef CONFIG_PM
    111		.pm	= &cma3000_i2c_pm_ops,
    112#endif
    113	},
    114};
    115
    116module_i2c_driver(cma3000_i2c_driver);
    117
    118MODULE_DESCRIPTION("CMA3000-D0x Accelerometer I2C Driver");
    119MODULE_LICENSE("GPL");
    120MODULE_AUTHOR("Hemanth V <hemanthv@ti.com>");