2 * B53 register access through SPI
4 * Copyright (C) 2011-2013 Jonas Gorski <jogo@openwrt.org>
6 * Permission to use, copy, modify, and/or distribute this software for any
7 * purpose with or without fee is hereby granted, provided that the above
8 * copyright notice and this permission notice appear in all copies.
10 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
11 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
12 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
13 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
14 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
15 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
16 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19 #include <asm/unaligned.h>
21 #include <linux/kernel.h>
22 #include <linux/module.h>
23 #include <linux/spi/spi.h>
24 #include <linux/platform_data/b53.h>
28 #define B53_SPI_DATA 0xf0
30 #define B53_SPI_STATUS 0xfe
31 #define B53_SPI_CMD_SPIF BIT(7)
32 #define B53_SPI_CMD_RACK BIT(5)
34 #define B53_SPI_CMD_READ 0x00
35 #define B53_SPI_CMD_WRITE 0x01
36 #define B53_SPI_CMD_NORMAL 0x60
37 #define B53_SPI_CMD_FAST 0x10
39 #define B53_SPI_PAGE_SELECT 0xff
41 static inline int b53_spi_read_reg(struct spi_device
*spi
, u8 reg
, u8
*val
,
46 txbuf
[0] = B53_SPI_CMD_NORMAL
| B53_SPI_CMD_READ
;
49 return spi_write_then_read(spi
, txbuf
, 2, val
, len
);
52 static inline int b53_spi_clear_status(struct spi_device
*spi
)
58 for (i
= 0; i
< 10; i
++) {
59 ret
= b53_spi_read_reg(spi
, B53_SPI_STATUS
, &rxbuf
, 1);
63 if (!(rxbuf
& B53_SPI_CMD_SPIF
))
75 static inline int b53_spi_set_page(struct spi_device
*spi
, u8 page
)
79 txbuf
[0] = B53_SPI_CMD_NORMAL
| B53_SPI_CMD_WRITE
;
80 txbuf
[1] = B53_SPI_PAGE_SELECT
;
83 return spi_write(spi
, txbuf
, sizeof(txbuf
));
86 static inline int b53_prepare_reg_access(struct spi_device
*spi
, u8 page
)
88 int ret
= b53_spi_clear_status(spi
);
93 return b53_spi_set_page(spi
, page
);
96 static int b53_spi_prepare_reg_read(struct spi_device
*spi
, u8 reg
)
102 ret
= b53_spi_read_reg(spi
, reg
, &rxbuf
, 1);
106 for (retry_count
= 0; retry_count
< 10; retry_count
++) {
107 ret
= b53_spi_read_reg(spi
, B53_SPI_STATUS
, &rxbuf
, 1);
111 if (rxbuf
& B53_SPI_CMD_RACK
)
117 if (retry_count
== 10)
123 static int b53_spi_read(struct b53_device
*dev
, u8 page
, u8 reg
, u8
*data
,
126 struct spi_device
*spi
= dev
->priv
;
129 ret
= b53_prepare_reg_access(spi
, page
);
133 ret
= b53_spi_prepare_reg_read(spi
, reg
);
137 return b53_spi_read_reg(spi
, B53_SPI_DATA
, data
, len
);
140 static int b53_spi_read8(struct b53_device
*dev
, u8 page
, u8 reg
, u8
*val
)
142 return b53_spi_read(dev
, page
, reg
, val
, 1);
145 static int b53_spi_read16(struct b53_device
*dev
, u8 page
, u8 reg
, u16
*val
)
147 int ret
= b53_spi_read(dev
, page
, reg
, (u8
*)val
, 2);
150 *val
= le16_to_cpu(*val
);
155 static int b53_spi_read32(struct b53_device
*dev
, u8 page
, u8 reg
, u32
*val
)
157 int ret
= b53_spi_read(dev
, page
, reg
, (u8
*)val
, 4);
160 *val
= le32_to_cpu(*val
);
165 static int b53_spi_read48(struct b53_device
*dev
, u8 page
, u8 reg
, u64
*val
)
170 ret
= b53_spi_read(dev
, page
, reg
, (u8
*)val
, 6);
172 *val
= le64_to_cpu(*val
);
177 static int b53_spi_read64(struct b53_device
*dev
, u8 page
, u8 reg
, u64
*val
)
179 int ret
= b53_spi_read(dev
, page
, reg
, (u8
*)val
, 8);
182 *val
= le64_to_cpu(*val
);
187 static int b53_spi_write8(struct b53_device
*dev
, u8 page
, u8 reg
, u8 value
)
189 struct spi_device
*spi
= dev
->priv
;
193 ret
= b53_prepare_reg_access(spi
, page
);
197 txbuf
[0] = B53_SPI_CMD_NORMAL
| B53_SPI_CMD_WRITE
;
201 return spi_write(spi
, txbuf
, sizeof(txbuf
));
204 static int b53_spi_write16(struct b53_device
*dev
, u8 page
, u8 reg
, u16 value
)
206 struct spi_device
*spi
= dev
->priv
;
210 ret
= b53_prepare_reg_access(spi
, page
);
214 txbuf
[0] = B53_SPI_CMD_NORMAL
| B53_SPI_CMD_WRITE
;
216 put_unaligned_le16(value
, &txbuf
[2]);
218 return spi_write(spi
, txbuf
, sizeof(txbuf
));
221 static int b53_spi_write32(struct b53_device
*dev
, u8 page
, u8 reg
, u32 value
)
223 struct spi_device
*spi
= dev
->priv
;
227 ret
= b53_prepare_reg_access(spi
, page
);
231 txbuf
[0] = B53_SPI_CMD_NORMAL
| B53_SPI_CMD_WRITE
;
233 put_unaligned_le32(value
, &txbuf
[2]);
235 return spi_write(spi
, txbuf
, sizeof(txbuf
));
238 static int b53_spi_write48(struct b53_device
*dev
, u8 page
, u8 reg
, u64 value
)
240 struct spi_device
*spi
= dev
->priv
;
244 ret
= b53_prepare_reg_access(spi
, page
);
248 txbuf
[0] = B53_SPI_CMD_NORMAL
| B53_SPI_CMD_WRITE
;
250 put_unaligned_le64(value
, &txbuf
[2]);
252 return spi_write(spi
, txbuf
, sizeof(txbuf
) - 2);
255 static int b53_spi_write64(struct b53_device
*dev
, u8 page
, u8 reg
, u64 value
)
257 struct spi_device
*spi
= dev
->priv
;
261 ret
= b53_prepare_reg_access(spi
, page
);
265 txbuf
[0] = B53_SPI_CMD_NORMAL
| B53_SPI_CMD_WRITE
;
267 put_unaligned_le64(value
, &txbuf
[2]);
269 return spi_write(spi
, txbuf
, sizeof(txbuf
));
272 static struct b53_io_ops b53_spi_ops
= {
273 .read8
= b53_spi_read8
,
274 .read16
= b53_spi_read16
,
275 .read32
= b53_spi_read32
,
276 .read48
= b53_spi_read48
,
277 .read64
= b53_spi_read64
,
278 .write8
= b53_spi_write8
,
279 .write16
= b53_spi_write16
,
280 .write32
= b53_spi_write32
,
281 .write48
= b53_spi_write48
,
282 .write64
= b53_spi_write64
,
285 static int b53_spi_probe(struct spi_device
*spi
)
287 struct b53_device
*dev
;
290 dev
= b53_switch_alloc(&spi
->dev
, &b53_spi_ops
, spi
);
294 if (spi
->dev
.platform_data
)
295 dev
->pdata
= spi
->dev
.platform_data
;
297 ret
= b53_switch_register(dev
);
301 spi_set_drvdata(spi
, dev
);
306 static int b53_spi_remove(struct spi_device
*spi
)
308 struct b53_device
*dev
= spi_get_drvdata(spi
);
311 b53_switch_remove(dev
);
316 static struct spi_driver b53_spi_driver
= {
318 .name
= "b53-switch",
319 .bus
= &spi_bus_type
,
320 .owner
= THIS_MODULE
,
322 .probe
= b53_spi_probe
,
323 .remove
= b53_spi_remove
,
326 module_spi_driver(b53_spi_driver
);
328 MODULE_AUTHOR("Jonas Gorski <jogo@openwrt.org>");
329 MODULE_DESCRIPTION("B53 SPI access driver");
330 MODULE_LICENSE("Dual BSD/GPL");