111 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*3 * Copyright (C) 2020 InvenSense, Inc.4 */5 6#include <linux/kernel.h>7#include <linux/device.h>8#include <linux/module.h>9#include <linux/mod_devicetable.h>10#include <linux/spi/spi.h>11#include <linux/regmap.h>12#include <linux/property.h>13 14#include "inv_icm42600.h"15 16static int inv_icm42600_spi_bus_setup(struct inv_icm42600_state *st)17{18 unsigned int mask, val;19 int ret;20 21 /* setup interface registers */22 val = INV_ICM42600_INTF_CONFIG6_I3C_EN |23 INV_ICM42600_INTF_CONFIG6_I3C_SDR_EN |24 INV_ICM42600_INTF_CONFIG6_I3C_DDR_EN;25 ret = regmap_update_bits(st->map, INV_ICM42600_REG_INTF_CONFIG6,26 INV_ICM42600_INTF_CONFIG6_MASK, val);27 if (ret)28 return ret;29 30 ret = regmap_clear_bits(st->map, INV_ICM42600_REG_INTF_CONFIG4,31 INV_ICM42600_INTF_CONFIG4_I3C_BUS_ONLY);32 if (ret)33 return ret;34 35 /* set slew rates for I2C and SPI */36 mask = INV_ICM42600_DRIVE_CONFIG_I2C_MASK |37 INV_ICM42600_DRIVE_CONFIG_SPI_MASK;38 val = INV_ICM42600_DRIVE_CONFIG_I2C(INV_ICM42600_SLEW_RATE_20_60NS) |39 INV_ICM42600_DRIVE_CONFIG_SPI(INV_ICM42600_SLEW_RATE_INF_2NS);40 ret = regmap_update_bits(st->map, INV_ICM42600_REG_DRIVE_CONFIG,41 mask, val);42 if (ret)43 return ret;44 45 /* disable i2c bus */46 return regmap_update_bits(st->map, INV_ICM42600_REG_INTF_CONFIG0,47 INV_ICM42600_INTF_CONFIG0_UI_SIFS_CFG_MASK,48 INV_ICM42600_INTF_CONFIG0_UI_SIFS_CFG_I2C_DIS);49}50 51static int inv_icm42600_probe(struct spi_device *spi)52{53 const void *match;54 enum inv_icm42600_chip chip;55 struct regmap *regmap;56 57 match = device_get_match_data(&spi->dev);58 if (!match)59 return -EINVAL;60 chip = (uintptr_t)match;61 62 regmap = devm_regmap_init_spi(spi, &inv_icm42600_regmap_config);63 if (IS_ERR(regmap))64 return PTR_ERR(regmap);65 66 return inv_icm42600_core_probe(regmap, chip, spi->irq,67 inv_icm42600_spi_bus_setup);68}69 70static const struct of_device_id inv_icm42600_of_matches[] = {71 {72 .compatible = "invensense,icm42600",73 .data = (void *)INV_CHIP_ICM42600,74 }, {75 .compatible = "invensense,icm42602",76 .data = (void *)INV_CHIP_ICM42602,77 }, {78 .compatible = "invensense,icm42605",79 .data = (void *)INV_CHIP_ICM42605,80 }, {81 .compatible = "invensense,icm42686",82 .data = (void *)INV_CHIP_ICM42686,83 }, {84 .compatible = "invensense,icm42622",85 .data = (void *)INV_CHIP_ICM42622,86 }, {87 .compatible = "invensense,icm42688",88 .data = (void *)INV_CHIP_ICM42688,89 }, {90 .compatible = "invensense,icm42631",91 .data = (void *)INV_CHIP_ICM42631,92 },93 {}94};95MODULE_DEVICE_TABLE(of, inv_icm42600_of_matches);96 97static struct spi_driver inv_icm42600_driver = {98 .driver = {99 .name = "inv-icm42600-spi",100 .of_match_table = inv_icm42600_of_matches,101 .pm = pm_ptr(&inv_icm42600_pm_ops),102 },103 .probe = inv_icm42600_probe,104};105module_spi_driver(inv_icm42600_driver);106 107MODULE_AUTHOR("InvenSense, Inc.");108MODULE_DESCRIPTION("InvenSense ICM-426xx SPI driver");109MODULE_LICENSE("GPL");110MODULE_IMPORT_NS(IIO_ICM42600);111