Blame view

drivers/base/regmap/regmap-spi.c 3.46 KB
a676f0830   Mark Brown   regmap: Add SPI b...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
  /*
   * Register map access API - SPI support
   *
   * Copyright 2011 Wolfson Microelectronics plc
   *
   * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License version 2 as
   * published by the Free Software Foundation.
   */
  
  #include <linux/regmap.h>
  #include <linux/spi/spi.h>
b5ddbf465   Stephen Rothwell   regmap: using mod...
15
  #include <linux/module.h>
a676f0830   Mark Brown   regmap: Add SPI b...
16

e0356dfe9   Mark Brown   regmap: spi: Supp...
17
18
19
20
21
22
23
24
25
26
27
28
29
30
  #include "internal.h"
  
  struct regmap_async_spi {
  	struct regmap_async core;
  	struct spi_message m;
  	struct spi_transfer t[2];
  };
  
  static void regmap_spi_complete(void *data)
  {
  	struct regmap_async_spi *async = data;
  
  	regmap_async_complete_cb(&async->core, async->m.status);
  }
0135bbcc7   Stephen Warren   regmap: introduce...
31
  static int regmap_spi_write(void *context, const void *data, size_t count)
a676f0830   Mark Brown   regmap: Add SPI b...
32
  {
0135bbcc7   Stephen Warren   regmap: introduce...
33
  	struct device *dev = context;
a676f0830   Mark Brown   regmap: Add SPI b...
34
35
36
37
  	struct spi_device *spi = to_spi_device(dev);
  
  	return spi_write(spi, data, count);
  }
0135bbcc7   Stephen Warren   regmap: introduce...
38
  static int regmap_spi_gather_write(void *context,
a676f0830   Mark Brown   regmap: Add SPI b...
39
40
41
  				   const void *reg, size_t reg_len,
  				   const void *val, size_t val_len)
  {
0135bbcc7   Stephen Warren   regmap: introduce...
42
  	struct device *dev = context;
a676f0830   Mark Brown   regmap: Add SPI b...
43
44
45
46
47
48
49
50
51
52
53
  	struct spi_device *spi = to_spi_device(dev);
  	struct spi_message m;
  	struct spi_transfer t[2] = { { .tx_buf = reg, .len = reg_len, },
  				     { .tx_buf = val, .len = val_len, }, };
  
  	spi_message_init(&m);
  	spi_message_add_tail(&t[0], &m);
  	spi_message_add_tail(&t[1], &m);
  
  	return spi_sync(spi, &m);
  }
e0356dfe9   Mark Brown   regmap: spi: Supp...
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
  static int regmap_spi_async_write(void *context,
  				  const void *reg, size_t reg_len,
  				  const void *val, size_t val_len,
  				  struct regmap_async *a)
  {
  	struct regmap_async_spi *async = container_of(a,
  						      struct regmap_async_spi,
  						      core);
  	struct device *dev = context;
  	struct spi_device *spi = to_spi_device(dev);
  
  	async->t[0].tx_buf = reg;
  	async->t[0].len = reg_len;
  	async->t[1].tx_buf = val;
  	async->t[1].len = val_len;
  
  	spi_message_init(&async->m);
  	spi_message_add_tail(&async->t[0], &async->m);
cd1b9dd02   Mark Brown   regmap: spi: Hand...
72
73
  	if (val)
  		spi_message_add_tail(&async->t[1], &async->m);
e0356dfe9   Mark Brown   regmap: spi: Supp...
74
75
76
77
78
79
80
81
82
83
84
85
  
  	async->m.complete = regmap_spi_complete;
  	async->m.context = async;
  
  	return spi_async(spi, &async->m);
  }
  
  static struct regmap_async *regmap_spi_async_alloc(void)
  {
  	struct regmap_async_spi *async_spi;
  
  	async_spi = kzalloc(sizeof(*async_spi), GFP_KERNEL);
95601d65a   Mark Brown   regmap: spi: Hand...
86
87
  	if (!async_spi)
  		return NULL;
e0356dfe9   Mark Brown   regmap: spi: Supp...
88
89
90
  
  	return &async_spi->core;
  }
0135bbcc7   Stephen Warren   regmap: introduce...
91
  static int regmap_spi_read(void *context,
a676f0830   Mark Brown   regmap: Add SPI b...
92
93
94
  			   const void *reg, size_t reg_size,
  			   void *val, size_t val_size)
  {
0135bbcc7   Stephen Warren   regmap: introduce...
95
  	struct device *dev = context;
a676f0830   Mark Brown   regmap: Add SPI b...
96
97
98
99
100
101
  	struct spi_device *spi = to_spi_device(dev);
  
  	return spi_write_then_read(spi, reg, reg_size, val, val_size);
  }
  
  static struct regmap_bus regmap_spi = {
a676f0830   Mark Brown   regmap: Add SPI b...
102
103
  	.write = regmap_spi_write,
  	.gather_write = regmap_spi_gather_write,
e0356dfe9   Mark Brown   regmap: spi: Supp...
104
105
  	.async_write = regmap_spi_async_write,
  	.async_alloc = regmap_spi_async_alloc,
a676f0830   Mark Brown   regmap: Add SPI b...
106
  	.read = regmap_spi_read,
a676f0830   Mark Brown   regmap: Add SPI b...
107
  	.read_flag_mask = 0x80,
d647c1995   Xiubo Li   regmap: add DT en...
108
109
  	.reg_format_endian_default = REGMAP_ENDIAN_BIG,
  	.val_format_endian_default = REGMAP_ENDIAN_BIG,
a676f0830   Mark Brown   regmap: Add SPI b...
110
  };
3cfe7a74d   Nicolas Boichat   regmap: Use diffe...
111
112
113
114
  struct regmap *__regmap_init_spi(struct spi_device *spi,
  				 const struct regmap_config *config,
  				 struct lock_class_key *lock_key,
  				 const char *lock_name)
a676f0830   Mark Brown   regmap: Add SPI b...
115
  {
3cfe7a74d   Nicolas Boichat   regmap: Use diffe...
116
117
  	return __regmap_init(&spi->dev, &regmap_spi, &spi->dev, config,
  			     lock_key, lock_name);
a676f0830   Mark Brown   regmap: Add SPI b...
118
  }
3cfe7a74d   Nicolas Boichat   regmap: Use diffe...
119
  EXPORT_SYMBOL_GPL(__regmap_init_spi);
b33f9cbd6   Stephen Warren   regmap: Specify a...
120

3cfe7a74d   Nicolas Boichat   regmap: Use diffe...
121
122
123
124
  struct regmap *__devm_regmap_init_spi(struct spi_device *spi,
  				      const struct regmap_config *config,
  				      struct lock_class_key *lock_key,
  				      const char *lock_name)
c0eb46766   Mark Brown   regmap: Implement...
125
  {
3cfe7a74d   Nicolas Boichat   regmap: Use diffe...
126
127
  	return __devm_regmap_init(&spi->dev, &regmap_spi, &spi->dev, config,
  				  lock_key, lock_name);
c0eb46766   Mark Brown   regmap: Implement...
128
  }
3cfe7a74d   Nicolas Boichat   regmap: Use diffe...
129
  EXPORT_SYMBOL_GPL(__devm_regmap_init_spi);
c0eb46766   Mark Brown   regmap: Implement...
130

b33f9cbd6   Stephen Warren   regmap: Specify a...
131
  MODULE_LICENSE("GPL");