brintos

brintos / linux-shallow public Read only

0
0
Text · 3.3 KiB · 6f8d73f Raw
123 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * ADXL313 3-Axis Digital Accelerometer4 *5 * Copyright (c) 2021 Lucas Stankus <lucas.p.stankus@gmail.com>6 *7 * Datasheet: https://www.analog.com/media/en/technical-documentation/data-sheets/ADXL313.pdf8 */9 10#include <linux/mod_devicetable.h>11#include <linux/module.h>12#include <linux/regmap.h>13#include <linux/spi/spi.h>14#include <linux/property.h>15 16#include "adxl313.h"17 18static const struct regmap_config adxl31x_spi_regmap_config[] = {19	[ADXL312] = {20		.reg_bits	= 8,21		.val_bits	= 8,22		.rd_table	= &adxl312_readable_regs_table,23		.wr_table	= &adxl312_writable_regs_table,24		.max_register	= 0x39,25		/* Setting bits 7 and 6 enables multiple-byte read */26		.read_flag_mask	= BIT(7) | BIT(6),27	},28	[ADXL313] = {29		.reg_bits	= 8,30		.val_bits	= 8,31		.rd_table	= &adxl313_readable_regs_table,32		.wr_table	= &adxl313_writable_regs_table,33		.max_register	= 0x39,34		/* Setting bits 7 and 6 enables multiple-byte read */35		.read_flag_mask	= BIT(7) | BIT(6),36	},37	[ADXL314] = {38		.reg_bits	= 8,39		.val_bits	= 8,40		.rd_table	= &adxl314_readable_regs_table,41		.wr_table	= &adxl314_writable_regs_table,42		.max_register	= 0x39,43		/* Setting bits 7 and 6 enables multiple-byte read */44		.read_flag_mask	= BIT(7) | BIT(6),45	},46};47 48static int adxl313_spi_setup(struct device *dev, struct regmap *regmap)49{50	struct spi_device *spi = container_of(dev, struct spi_device, dev);51	int ret;52 53	if (spi->mode & SPI_3WIRE) {54		ret = regmap_write(regmap, ADXL313_REG_DATA_FORMAT,55				   ADXL313_SPI_3WIRE);56		if (ret)57			return ret;58	}59 60	return regmap_update_bits(regmap, ADXL313_REG_POWER_CTL,61				  ADXL313_I2C_DISABLE, ADXL313_I2C_DISABLE);62}63 64static int adxl313_spi_probe(struct spi_device *spi)65{66	const struct adxl313_chip_info *chip_data;67	struct regmap *regmap;68	int ret;69 70	spi->mode |= SPI_MODE_3;71	ret = spi_setup(spi);72	if (ret)73		return ret;74 75	chip_data = spi_get_device_match_data(spi);76 77	regmap = devm_regmap_init_spi(spi,78				      &adxl31x_spi_regmap_config[chip_data->type]);79 80	if (IS_ERR(regmap)) {81		dev_err(&spi->dev, "Error initializing spi regmap: %ld\n",82			PTR_ERR(regmap));83		return PTR_ERR(regmap);84	}85 86	return adxl313_core_probe(&spi->dev, regmap,87				  chip_data, &adxl313_spi_setup);88}89 90static const struct spi_device_id adxl313_spi_id[] = {91	{ .name = "adxl312", .driver_data = (kernel_ulong_t)&adxl31x_chip_info[ADXL312] },92	{ .name = "adxl313", .driver_data = (kernel_ulong_t)&adxl31x_chip_info[ADXL313] },93	{ .name = "adxl314", .driver_data = (kernel_ulong_t)&adxl31x_chip_info[ADXL314] },94	{ }95};96 97MODULE_DEVICE_TABLE(spi, adxl313_spi_id);98 99static const struct of_device_id adxl313_of_match[] = {100	{ .compatible = "adi,adxl312", .data = &adxl31x_chip_info[ADXL312] },101	{ .compatible = "adi,adxl313", .data = &adxl31x_chip_info[ADXL313] },102	{ .compatible = "adi,adxl314", .data = &adxl31x_chip_info[ADXL314] },103	{ }104};105 106MODULE_DEVICE_TABLE(of, adxl313_of_match);107 108static struct spi_driver adxl313_spi_driver = {109	.driver = {110		.name	= "adxl313_spi",111		.of_match_table = adxl313_of_match,112	},113	.probe		= adxl313_spi_probe,114	.id_table	= adxl313_spi_id,115};116 117module_spi_driver(adxl313_spi_driver);118 119MODULE_AUTHOR("Lucas Stankus <lucas.p.stankus@gmail.com>");120MODULE_DESCRIPTION("ADXL313 3-Axis Digital Accelerometer SPI driver");121MODULE_LICENSE("GPL v2");122MODULE_IMPORT_NS(IIO_ADXL313);123