mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-03 00:54:09 +08:00
cc5f2eb7ce
These error paths accidentally return success when they should return
-EINVAL.
Fixes: 325bec7157 ("mfd: tps6594: Add driver for TI TPS6594 PMIC")
Signed-off-by: Dan Carpenter <dan.carpenter@linaro.org>
Link: https://lore.kernel.org/r/49f7cd8f-f7eb-40f1-91e8-291620c684df@kili.mountain
Signed-off-by: Lee Jones <lee@kernel.org>
130 lines
3.3 KiB
C
130 lines
3.3 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* SPI access driver for TI TPS6594/TPS6593/LP8764 PMICs
|
|
*
|
|
* Copyright (C) 2023 BayLibre Incorporated - https://www.baylibre.com/
|
|
*/
|
|
|
|
#include <linux/crc8.h>
|
|
#include <linux/module.h>
|
|
#include <linux/mod_devicetable.h>
|
|
#include <linux/of_device.h>
|
|
#include <linux/regmap.h>
|
|
#include <linux/spi/spi.h>
|
|
|
|
#include <linux/mfd/tps6594.h>
|
|
|
|
#define TPS6594_SPI_PAGE_SHIFT 5
|
|
#define TPS6594_SPI_READ_BIT BIT(4)
|
|
|
|
static bool enable_crc;
|
|
module_param(enable_crc, bool, 0444);
|
|
MODULE_PARM_DESC(enable_crc, "Enable CRC feature for SPI interface");
|
|
|
|
DECLARE_CRC8_TABLE(tps6594_spi_crc_table);
|
|
|
|
static int tps6594_spi_reg_read(void *context, unsigned int reg, unsigned int *val)
|
|
{
|
|
struct spi_device *spi = context;
|
|
struct tps6594 *tps = spi_get_drvdata(spi);
|
|
u8 buf[4] = { 0 };
|
|
size_t count_rx = 1;
|
|
int ret;
|
|
|
|
buf[0] = reg;
|
|
buf[1] = TPS6594_REG_TO_PAGE(reg) << TPS6594_SPI_PAGE_SHIFT | TPS6594_SPI_READ_BIT;
|
|
|
|
if (tps->use_crc)
|
|
count_rx++;
|
|
|
|
ret = spi_write_then_read(spi, buf, 2, buf + 2, count_rx);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
if (tps->use_crc && buf[3] != crc8(tps6594_spi_crc_table, buf, 3, CRC8_INIT_VALUE))
|
|
return -EIO;
|
|
|
|
*val = buf[2];
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tps6594_spi_reg_write(void *context, unsigned int reg, unsigned int val)
|
|
{
|
|
struct spi_device *spi = context;
|
|
struct tps6594 *tps = spi_get_drvdata(spi);
|
|
u8 buf[4] = { 0 };
|
|
size_t count = 3;
|
|
|
|
buf[0] = reg;
|
|
buf[1] = TPS6594_REG_TO_PAGE(reg) << TPS6594_SPI_PAGE_SHIFT;
|
|
buf[2] = val;
|
|
|
|
if (tps->use_crc)
|
|
buf[3] = crc8(tps6594_spi_crc_table, buf, count++, CRC8_INIT_VALUE);
|
|
|
|
return spi_write(spi, buf, count);
|
|
}
|
|
|
|
static const struct regmap_config tps6594_spi_regmap_config = {
|
|
.reg_bits = 16,
|
|
.val_bits = 8,
|
|
.max_register = TPS6594_REG_DWD_FAIL_CNT_REG,
|
|
.volatile_reg = tps6594_is_volatile_reg,
|
|
.reg_read = tps6594_spi_reg_read,
|
|
.reg_write = tps6594_spi_reg_write,
|
|
.use_single_read = true,
|
|
.use_single_write = true,
|
|
};
|
|
|
|
static const struct of_device_id tps6594_spi_of_match_table[] = {
|
|
{ .compatible = "ti,tps6594-q1", .data = (void *)TPS6594, },
|
|
{ .compatible = "ti,tps6593-q1", .data = (void *)TPS6593, },
|
|
{ .compatible = "ti,lp8764-q1", .data = (void *)LP8764, },
|
|
{}
|
|
};
|
|
MODULE_DEVICE_TABLE(of, tps6594_spi_of_match_table);
|
|
|
|
static int tps6594_spi_probe(struct spi_device *spi)
|
|
{
|
|
struct device *dev = &spi->dev;
|
|
struct tps6594 *tps;
|
|
const struct of_device_id *match;
|
|
|
|
tps = devm_kzalloc(dev, sizeof(*tps), GFP_KERNEL);
|
|
if (!tps)
|
|
return -ENOMEM;
|
|
|
|
spi_set_drvdata(spi, tps);
|
|
|
|
tps->dev = dev;
|
|
tps->reg = spi->chip_select;
|
|
tps->irq = spi->irq;
|
|
|
|
tps->regmap = devm_regmap_init(dev, NULL, spi, &tps6594_spi_regmap_config);
|
|
if (IS_ERR(tps->regmap))
|
|
return dev_err_probe(dev, PTR_ERR(tps->regmap), "Failed to init regmap\n");
|
|
|
|
match = of_match_device(tps6594_spi_of_match_table, dev);
|
|
if (!match)
|
|
return dev_err_probe(dev, -EINVAL, "Failed to find matching chip ID\n");
|
|
tps->chip_id = (unsigned long)match->data;
|
|
|
|
crc8_populate_msb(tps6594_spi_crc_table, TPS6594_CRC8_POLYNOMIAL);
|
|
|
|
return tps6594_device_init(tps, enable_crc);
|
|
}
|
|
|
|
static struct spi_driver tps6594_spi_driver = {
|
|
.driver = {
|
|
.name = "tps6594",
|
|
.of_match_table = tps6594_spi_of_match_table,
|
|
},
|
|
.probe = tps6594_spi_probe,
|
|
};
|
|
module_spi_driver(tps6594_spi_driver);
|
|
|
|
MODULE_AUTHOR("Julien Panis <jpanis@baylibre.com>");
|
|
MODULE_DESCRIPTION("TPS6594 SPI Interface Driver");
|
|
MODULE_LICENSE("GPL");
|