98 lines · c
1// SPDX-License-Identifier: GPL-2.02/*3 * 3-axis accelerometer driver supporting following Bosch-Sensortec chips:4 * - BMI0885 * - BMI0856 * - BMI090L7 *8 * Copyright (c) 2018-2020, Topic Embedded Products9 */10 11#include <linux/module.h>12#include <linux/regmap.h>13#include <linux/slab.h>14#include <linux/spi/spi.h>15 16#include "bmi088-accel.h"17 18static int bmi088_regmap_spi_write(void *context, const void *data, size_t count)19{20 struct spi_device *spi = context;21 22 /* Write register is same as generic SPI */23 return spi_write(spi, data, count);24}25 26static int bmi088_regmap_spi_read(void *context, const void *reg,27 size_t reg_size, void *val, size_t val_size)28{29 struct spi_device *spi = context;30 u8 addr[2];31 32 addr[0] = *(u8 *)reg;33 addr[0] |= BIT(7); /* Set RW = '1' */34 addr[1] = 0; /* Read requires a dummy byte transfer */35 36 return spi_write_then_read(spi, addr, sizeof(addr), val, val_size);37}38 39static const struct regmap_bus bmi088_regmap_bus = {40 .write = bmi088_regmap_spi_write,41 .read = bmi088_regmap_spi_read,42};43 44static int bmi088_accel_probe(struct spi_device *spi)45{46 struct regmap *regmap;47 const struct spi_device_id *id = spi_get_device_id(spi);48 49 regmap = devm_regmap_init(&spi->dev, &bmi088_regmap_bus,50 spi, &bmi088_regmap_conf);51 52 if (IS_ERR(regmap)) {53 dev_err(&spi->dev, "Failed to initialize spi regmap\n");54 return PTR_ERR(regmap);55 }56 57 return bmi088_accel_core_probe(&spi->dev, regmap, spi->irq,58 id->driver_data);59}60 61static void bmi088_accel_remove(struct spi_device *spi)62{63 bmi088_accel_core_remove(&spi->dev);64}65 66static const struct of_device_id bmi088_of_match[] = {67 { .compatible = "bosch,bmi085-accel" },68 { .compatible = "bosch,bmi088-accel" },69 { .compatible = "bosch,bmi090l-accel" },70 {}71};72MODULE_DEVICE_TABLE(of, bmi088_of_match);73 74static const struct spi_device_id bmi088_accel_id[] = {75 {"bmi085-accel", BOSCH_BMI085},76 {"bmi088-accel", BOSCH_BMI088},77 {"bmi090l-accel", BOSCH_BMI090L},78 {}79};80MODULE_DEVICE_TABLE(spi, bmi088_accel_id);81 82static struct spi_driver bmi088_accel_driver = {83 .driver = {84 .name = "bmi088_accel_spi",85 .pm = pm_ptr(&bmi088_accel_pm_ops),86 .of_match_table = bmi088_of_match,87 },88 .probe = bmi088_accel_probe,89 .remove = bmi088_accel_remove,90 .id_table = bmi088_accel_id,91};92module_spi_driver(bmi088_accel_driver);93 94MODULE_AUTHOR("Niek van Agt <niek.van.agt@topicproducts.com>");95MODULE_LICENSE("GPL v2");96MODULE_DESCRIPTION("BMI088 accelerometer driver (SPI)");97MODULE_IMPORT_NS(IIO_BMI088);98