Quelle  cs40l50-i2c.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/*
 * CS40L50 Advanced Haptic Driver with waveform memory,
 * integrated DSP, and closed-loop algorithms
 *
 * Copyright 2024 Cirrus Logic, Inc.
 *
 * Author: James Ogletree <james.ogletree@cirrus.com>
 */

#include <linux/i2c.h>
#include <linux/mfd/cs40l50.h>

static int cs40l50_i2c_probe(struct i2c_client *i2c)
{
 struct cs40l50 *cs40l50;

 cs40l50 = devm_kzalloc(&i2c->dev, sizeof(*cs40l50), GFP_KERNEL);
 if (!cs40l50)
  return -ENOMEM;

 i2c_set_clientdata(i2c, cs40l50);

 cs40l50->dev = &i2c->dev;
 cs40l50->irq = i2c->irq;

 cs40l50->regmap = devm_regmap_init_i2c(i2c, &cs40l50_regmap);
 if (IS_ERR(cs40l50->regmap))
  return dev_err_probe(cs40l50->dev, PTR_ERR(cs40l50->regmap),
         "Failed to initialize register map\n");

 return cs40l50_probe(cs40l50);
}

static void cs40l50_i2c_remove(struct i2c_client *i2c)
{
 struct cs40l50 *cs40l50 = i2c_get_clientdata(i2c);

 cs40l50_remove(cs40l50);
}

static const struct i2c_device_id cs40l50_id_i2c[] = {
 { "cs40l50" },
 {}
};
MODULE_DEVICE_TABLE(i2c, cs40l50_id_i2c);

static const struct of_device_id cs40l50_of_match[] = {
 { .compatible = "cirrus,cs40l50" },
 {}
};
MODULE_DEVICE_TABLE(of, cs40l50_of_match);

static struct i2c_driver cs40l50_i2c_driver = {
 .driver = {
  .name = "cs40l50",
  .of_match_table = cs40l50_of_match,
  .pm = pm_ptr(&cs40l50_pm_ops),
 },
 .id_table = cs40l50_id_i2c,
 .probe = cs40l50_i2c_probe,
 .remove = cs40l50_i2c_remove,
};
module_i2c_driver(cs40l50_i2c_driver);

MODULE_DESCRIPTION("CS40L50 I2C Driver");
MODULE_AUTHOR("James Ogletree, Cirrus Logic Inc. ");
MODULE_LICENSE("GPL");