Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 | // SPDX-License-Identifier: GPL-2.0-only /* * Freescale MPL115A1 pressure/temperature sensor * * Copyright (c) 2016 Akinobu Mita <akinobu.mita@gmail.com> * * Datasheet: http://www.nxp.com/files/sensors/doc/data_sheet/MPL115A1.pdf */ #include <linux/module.h> #include <linux/spi/spi.h> #include "mpl115.h" #define MPL115_SPI_WRITE(address) ((address) << 1) #define MPL115_SPI_READ(address) (0x80 | (address) << 1) struct mpl115_spi_buf { u8 tx[4]; u8 rx[4]; }; static int mpl115_spi_init(struct device *dev) { struct spi_device *spi = to_spi_device(dev); struct mpl115_spi_buf *buf; buf = devm_kzalloc(dev, sizeof(*buf), GFP_KERNEL); if (!buf) return -ENOMEM; spi_set_drvdata(spi, buf); return 0; } static int mpl115_spi_read(struct device *dev, u8 address) { struct spi_device *spi = to_spi_device(dev); struct mpl115_spi_buf *buf = spi_get_drvdata(spi); struct spi_transfer xfer = { .tx_buf = buf->tx, .rx_buf = buf->rx, .len = 4, }; int ret; buf->tx[0] = MPL115_SPI_READ(address); buf->tx[2] = MPL115_SPI_READ(address + 1); ret = spi_sync_transfer(spi, &xfer, 1); if (ret) return ret; return (buf->rx[1] << 8) | buf->rx[3]; } static int mpl115_spi_write(struct device *dev, u8 address, u8 value) { struct spi_device *spi = to_spi_device(dev); struct mpl115_spi_buf *buf = spi_get_drvdata(spi); struct spi_transfer xfer = { .tx_buf = buf->tx, .len = 2, }; buf->tx[0] = MPL115_SPI_WRITE(address); buf->tx[1] = value; return spi_sync_transfer(spi, &xfer, 1); } static const struct mpl115_ops mpl115_spi_ops = { .init = mpl115_spi_init, .read = mpl115_spi_read, .write = mpl115_spi_write, }; static int mpl115_spi_probe(struct spi_device *spi) { const struct spi_device_id *id = spi_get_device_id(spi); return mpl115_probe(&spi->dev, id->name, &mpl115_spi_ops); } static const struct spi_device_id mpl115_spi_ids[] = { { "mpl115", 0 }, {} }; MODULE_DEVICE_TABLE(spi, mpl115_spi_ids); static struct spi_driver mpl115_spi_driver = { .driver = { .name = "mpl115", }, .probe = mpl115_spi_probe, .id_table = mpl115_spi_ids, }; module_spi_driver(mpl115_spi_driver); MODULE_AUTHOR("Akinobu Mita <akinobu.mita@gmail.com>"); MODULE_DESCRIPTION("Freescale MPL115A1 pressure/temperature driver"); MODULE_LICENSE("GPL"); |