hc
2023-02-13 e440ec23c5a540cdd3f7464e8779219be6fd3d95
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
104
105
106
107
108
109
110
111
112
113
114
115
116
117
/*
 * ADT7310/ADT7310 digital temperature sensor driver
 *
 * Copyright 2012-2013 Analog Devices Inc.
 *   Author: Lars-Peter Clausen <lars@metafoo.de>
 *
 * Licensed under the GPL-2 or later.
 */
 
#include <linux/module.h>
#include <linux/init.h>
#include <linux/spi/spi.h>
#include <asm/unaligned.h>
 
#include "adt7x10.h"
 
#define ADT7310_STATUS            0
#define ADT7310_CONFIG            1
#define ADT7310_TEMPERATURE        2
#define ADT7310_ID            3
#define ADT7310_T_CRIT            4
#define ADT7310_T_HYST            5
#define ADT7310_T_ALARM_HIGH        6
#define ADT7310_T_ALARM_LOW        7
 
static const u8 adt7310_reg_table[] = {
   [ADT7X10_TEMPERATURE]   = ADT7310_TEMPERATURE,
   [ADT7X10_STATUS]    = ADT7310_STATUS,
   [ADT7X10_CONFIG]    = ADT7310_CONFIG,
   [ADT7X10_T_ALARM_HIGH]    = ADT7310_T_ALARM_HIGH,
   [ADT7X10_T_ALARM_LOW]    = ADT7310_T_ALARM_LOW,
   [ADT7X10_T_CRIT]    = ADT7310_T_CRIT,
   [ADT7X10_T_HYST]    = ADT7310_T_HYST,
   [ADT7X10_ID]        = ADT7310_ID,
};
 
#define ADT7310_CMD_REG_OFFSET    3
#define ADT7310_CMD_READ    0x40
 
#define AD7310_COMMAND(reg) (adt7310_reg_table[(reg)] << ADT7310_CMD_REG_OFFSET)
 
static int adt7310_spi_read_word(struct device *dev, u8 reg)
{
   struct spi_device *spi = to_spi_device(dev);
 
   return spi_w8r16be(spi, AD7310_COMMAND(reg) | ADT7310_CMD_READ);
}
 
static int adt7310_spi_write_word(struct device *dev, u8 reg, u16 data)
{
   struct spi_device *spi = to_spi_device(dev);
   u8 buf[3];
 
   buf[0] = AD7310_COMMAND(reg);
   put_unaligned_be16(data, &buf[1]);
 
   return spi_write(spi, buf, sizeof(buf));
}
 
static int adt7310_spi_read_byte(struct device *dev, u8 reg)
{
   struct spi_device *spi = to_spi_device(dev);
 
   return spi_w8r8(spi, AD7310_COMMAND(reg) | ADT7310_CMD_READ);
}
 
static int adt7310_spi_write_byte(struct device *dev, u8 reg,
   u8 data)
{
   struct spi_device *spi = to_spi_device(dev);
   u8 buf[2];
 
   buf[0] = AD7310_COMMAND(reg);
   buf[1] = data;
 
   return spi_write(spi, buf, sizeof(buf));
}
 
static const struct adt7x10_ops adt7310_spi_ops = {
   .read_word = adt7310_spi_read_word,
   .write_word = adt7310_spi_write_word,
   .read_byte = adt7310_spi_read_byte,
   .write_byte = adt7310_spi_write_byte,
};
 
static int adt7310_spi_probe(struct spi_device *spi)
{
   return adt7x10_probe(&spi->dev, spi_get_device_id(spi)->name, spi->irq,
           &adt7310_spi_ops);
}
 
static int adt7310_spi_remove(struct spi_device *spi)
{
   return adt7x10_remove(&spi->dev, spi->irq);
}
 
static const struct spi_device_id adt7310_id[] = {
   { "adt7310", 0 },
   { "adt7320", 0 },
   {}
};
MODULE_DEVICE_TABLE(spi, adt7310_id);
 
static struct spi_driver adt7310_driver = {
   .driver = {
       .name    = "adt7310",
       .pm    = ADT7X10_DEV_PM_OPS,
   },
   .probe        = adt7310_spi_probe,
   .remove        = adt7310_spi_remove,
   .id_table    = adt7310_id,
};
module_spi_driver(adt7310_driver);
 
MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");
MODULE_DESCRIPTION("ADT7310/ADT7320 driver");
MODULE_LICENSE("GPL");