| /* |
| * STMicroelectronics st_asm330lhh spi driver |
| * |
| * Copyright 2018 STMicroelectronics Inc. |
| * |
| * Lorenzo Bianconi <lorenzo.bianconi@st.com> |
| * |
| * Licensed under the GPL-2. |
| */ |
| |
| #include <linux/kernel.h> |
| #include <linux/module.h> |
| #include <linux/spi/spi.h> |
| #include <linux/slab.h> |
| #include <linux/of.h> |
| |
| #include "st_asm330lhh.h" |
| |
| #define SENSORS_SPI_READ BIT(7) |
| |
| static int st_asm330lhh_spi_read(struct device *dev, u8 addr, int len, |
| u8 *data) |
| { |
| struct spi_device *spi = to_spi_device(dev); |
| struct st_asm330lhh_hw *hw = spi_get_drvdata(spi); |
| int err; |
| |
| struct spi_transfer xfers[] = { |
| { |
| .tx_buf = hw->tb.tx_buf, |
| .bits_per_word = 8, |
| .len = 1, |
| }, |
| { |
| .rx_buf = hw->tb.rx_buf, |
| .bits_per_word = 8, |
| .len = len, |
| } |
| }; |
| |
| hw->tb.tx_buf[0] = addr | SENSORS_SPI_READ; |
| |
| err = spi_sync_transfer(spi, xfers, ARRAY_SIZE(xfers)); |
| if (err < 0) |
| return err; |
| |
| memcpy(data, hw->tb.rx_buf, len * sizeof(u8)); |
| |
| return len; |
| } |
| |
| static int st_asm330lhh_spi_write(struct device *dev, u8 addr, int len, |
| u8 *data) |
| { |
| struct st_asm330lhh_hw *hw; |
| struct spi_device *spi; |
| |
| if (len >= ST_ASM330LHH_TX_MAX_LENGTH) |
| return -ENOMEM; |
| |
| spi = to_spi_device(dev); |
| hw = spi_get_drvdata(spi); |
| |
| hw->tb.tx_buf[0] = addr; |
| memcpy(&hw->tb.tx_buf[1], data, len); |
| |
| return spi_write(spi, hw->tb.tx_buf, len + 1); |
| } |
| |
| static const struct st_asm330lhh_transfer_function st_asm330lhh_transfer_fn = { |
| .read = st_asm330lhh_spi_read, |
| .write = st_asm330lhh_spi_write, |
| }; |
| |
| static int st_asm330lhh_spi_probe(struct spi_device *spi) |
| { |
| return st_asm330lhh_probe(&spi->dev, spi->irq, |
| &st_asm330lhh_transfer_fn); |
| } |
| |
| static const struct of_device_id st_asm330lhh_spi_of_match[] = { |
| { |
| .compatible = "st,asm330lhh", |
| }, |
| {}, |
| }; |
| MODULE_DEVICE_TABLE(of, st_asm330lhh_spi_of_match); |
| |
| static const struct spi_device_id st_asm330lhh_spi_id_table[] = { |
| { ST_ASM330LHH_DEV_NAME }, |
| {}, |
| }; |
| MODULE_DEVICE_TABLE(spi, st_asm330lhh_spi_id_table); |
| |
| static struct spi_driver st_asm330lhh_driver = { |
| .driver = { |
| .name = "st_asm330lhh_spi", |
| .pm = &st_asm330lhh_pm_ops, |
| .of_match_table = of_match_ptr(st_asm330lhh_spi_of_match), |
| }, |
| .probe = st_asm330lhh_spi_probe, |
| .id_table = st_asm330lhh_spi_id_table, |
| }; |
| module_spi_driver(st_asm330lhh_driver); |
| |
| MODULE_AUTHOR("Lorenzo Bianconi <lorenzo.bianconi@st.com>"); |
| MODULE_DESCRIPTION("STMicroelectronics st_asm330lhh spi driver"); |
| MODULE_LICENSE("GPL v2"); |
| MODULE_VERSION(ST_ASM330LHH_VERSION); |