xref: /openbmc/linux/drivers/media/i2c/s5c73m3/s5c73m3-spi.c (revision 03ab8e6297acd1bc0eedaa050e2a1635c576fd11)
1*1802d0beSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2cac47f18SAndrzej Hajda /*
3cac47f18SAndrzej Hajda  * Samsung LSI S5C73M3 8M pixel camera driver
4cac47f18SAndrzej Hajda  *
5cac47f18SAndrzej Hajda  * Copyright (C) 2012, Samsung Electronics, Co., Ltd.
6cac47f18SAndrzej Hajda  * Sylwester Nawrocki <s.nawrocki@samsung.com>
7cac47f18SAndrzej Hajda  * Andrzej Hajda <a.hajda@samsung.com>
8cac47f18SAndrzej Hajda  */
9cac47f18SAndrzej Hajda 
10cac47f18SAndrzej Hajda #include <linux/sizes.h>
11cac47f18SAndrzej Hajda #include <linux/delay.h>
12cac47f18SAndrzej Hajda #include <linux/init.h>
13cac47f18SAndrzej Hajda #include <linux/media.h>
14cac47f18SAndrzej Hajda #include <linux/module.h>
15cac47f18SAndrzej Hajda #include <linux/slab.h>
16cac47f18SAndrzej Hajda #include <linux/spi/spi.h>
17cac47f18SAndrzej Hajda 
18cac47f18SAndrzej Hajda #include "s5c73m3.h"
19cac47f18SAndrzej Hajda 
20cac47f18SAndrzej Hajda #define S5C73M3_SPI_DRV_NAME "S5C73M3-SPI"
21cac47f18SAndrzej Hajda 
22bce6744dSSylwester Nawrocki static const struct of_device_id s5c73m3_spi_ids[] = {
23bce6744dSSylwester Nawrocki 	{ .compatible = "samsung,s5c73m3" },
24bce6744dSSylwester Nawrocki 	{ }
25bce6744dSSylwester Nawrocki };
265aa2ccfcSJavier Martinez Canillas MODULE_DEVICE_TABLE(of, s5c73m3_spi_ids);
27bce6744dSSylwester Nawrocki 
28cac47f18SAndrzej Hajda enum spi_direction {
29cac47f18SAndrzej Hajda 	SPI_DIR_RX,
30cac47f18SAndrzej Hajda 	SPI_DIR_TX
31cac47f18SAndrzej Hajda };
32cac47f18SAndrzej Hajda 
spi_xmit(struct spi_device * spi_dev,void * addr,const int len,enum spi_direction dir)33cac47f18SAndrzej Hajda static int spi_xmit(struct spi_device *spi_dev, void *addr, const int len,
34cac47f18SAndrzej Hajda 							enum spi_direction dir)
35cac47f18SAndrzej Hajda {
36cac47f18SAndrzej Hajda 	struct spi_message msg;
37cac47f18SAndrzej Hajda 	int r;
38cac47f18SAndrzej Hajda 	struct spi_transfer xfer = {
39cac47f18SAndrzej Hajda 		.len	= len,
40cac47f18SAndrzej Hajda 	};
41cac47f18SAndrzej Hajda 
42cac47f18SAndrzej Hajda 	if (dir == SPI_DIR_TX)
43cac47f18SAndrzej Hajda 		xfer.tx_buf = addr;
44cac47f18SAndrzej Hajda 	else
45cac47f18SAndrzej Hajda 		xfer.rx_buf = addr;
46cac47f18SAndrzej Hajda 
47cac47f18SAndrzej Hajda 	if (spi_dev == NULL) {
4848205533STapasweni Pathak 		pr_err("SPI device is uninitialized\n");
49cac47f18SAndrzej Hajda 		return -ENODEV;
50cac47f18SAndrzej Hajda 	}
51cac47f18SAndrzej Hajda 
52cac47f18SAndrzej Hajda 	spi_message_init(&msg);
53cac47f18SAndrzej Hajda 	spi_message_add_tail(&xfer, &msg);
54cac47f18SAndrzej Hajda 
55cac47f18SAndrzej Hajda 	r = spi_sync(spi_dev, &msg);
56cac47f18SAndrzej Hajda 	if (r < 0)
57cac47f18SAndrzej Hajda 		dev_err(&spi_dev->dev, "%s spi_sync failed %d\n", __func__, r);
58cac47f18SAndrzej Hajda 
59cac47f18SAndrzej Hajda 	return r;
60cac47f18SAndrzej Hajda }
61cac47f18SAndrzej Hajda 
s5c73m3_spi_write(struct s5c73m3 * state,const void * addr,const unsigned int len,const unsigned int tx_size)62cac47f18SAndrzej Hajda int s5c73m3_spi_write(struct s5c73m3 *state, const void *addr,
63cac47f18SAndrzej Hajda 		      const unsigned int len, const unsigned int tx_size)
64cac47f18SAndrzej Hajda {
65cac47f18SAndrzej Hajda 	struct spi_device *spi_dev = state->spi_dev;
66cac47f18SAndrzej Hajda 	u32 count = len / tx_size;
67cac47f18SAndrzej Hajda 	u32 extra = len % tx_size;
68cac47f18SAndrzej Hajda 	unsigned int i, j = 0;
69cac47f18SAndrzej Hajda 	u8 padding[32];
70cac47f18SAndrzej Hajda 	int r = 0;
71cac47f18SAndrzej Hajda 
72cac47f18SAndrzej Hajda 	memset(padding, 0, sizeof(padding));
73cac47f18SAndrzej Hajda 
74cac47f18SAndrzej Hajda 	for (i = 0; i < count; i++) {
75cac47f18SAndrzej Hajda 		r = spi_xmit(spi_dev, (void *)addr + j, tx_size, SPI_DIR_TX);
76cac47f18SAndrzej Hajda 		if (r < 0)
77cac47f18SAndrzej Hajda 			return r;
78cac47f18SAndrzej Hajda 		j += tx_size;
79cac47f18SAndrzej Hajda 	}
80cac47f18SAndrzej Hajda 
81cac47f18SAndrzej Hajda 	if (extra > 0) {
82cac47f18SAndrzej Hajda 		r = spi_xmit(spi_dev, (void *)addr + j, extra, SPI_DIR_TX);
83cac47f18SAndrzej Hajda 		if (r < 0)
84cac47f18SAndrzej Hajda 			return r;
85cac47f18SAndrzej Hajda 	}
86cac47f18SAndrzej Hajda 
87cac47f18SAndrzej Hajda 	return spi_xmit(spi_dev, padding, sizeof(padding), SPI_DIR_TX);
88cac47f18SAndrzej Hajda }
89cac47f18SAndrzej Hajda 
s5c73m3_spi_read(struct s5c73m3 * state,void * addr,const unsigned int len,const unsigned int tx_size)90cac47f18SAndrzej Hajda int s5c73m3_spi_read(struct s5c73m3 *state, void *addr,
91cac47f18SAndrzej Hajda 		     const unsigned int len, const unsigned int tx_size)
92cac47f18SAndrzej Hajda {
93cac47f18SAndrzej Hajda 	struct spi_device *spi_dev = state->spi_dev;
94cac47f18SAndrzej Hajda 	u32 count = len / tx_size;
95cac47f18SAndrzej Hajda 	u32 extra = len % tx_size;
96cac47f18SAndrzej Hajda 	unsigned int i, j = 0;
97cac47f18SAndrzej Hajda 	int r = 0;
98cac47f18SAndrzej Hajda 
99cac47f18SAndrzej Hajda 	for (i = 0; i < count; i++) {
100cac47f18SAndrzej Hajda 		r = spi_xmit(spi_dev, addr + j, tx_size, SPI_DIR_RX);
101cac47f18SAndrzej Hajda 		if (r < 0)
102cac47f18SAndrzej Hajda 			return r;
103cac47f18SAndrzej Hajda 		j += tx_size;
104cac47f18SAndrzej Hajda 	}
105cac47f18SAndrzej Hajda 
106cac47f18SAndrzej Hajda 	if (extra > 0)
107cac47f18SAndrzej Hajda 		return spi_xmit(spi_dev, addr + j, extra, SPI_DIR_RX);
108cac47f18SAndrzej Hajda 
109cac47f18SAndrzej Hajda 	return 0;
110cac47f18SAndrzej Hajda }
111cac47f18SAndrzej Hajda 
s5c73m3_spi_probe(struct spi_device * spi)112c2668c08SSylwester Nawrocki static int s5c73m3_spi_probe(struct spi_device *spi)
113cac47f18SAndrzej Hajda {
114cac47f18SAndrzej Hajda 	int r;
115cac47f18SAndrzej Hajda 	struct s5c73m3 *state = container_of(spi->dev.driver, struct s5c73m3,
116cac47f18SAndrzej Hajda 					     spidrv.driver);
117cac47f18SAndrzej Hajda 	spi->bits_per_word = 32;
118cac47f18SAndrzej Hajda 
119cac47f18SAndrzej Hajda 	r = spi_setup(spi);
120cac47f18SAndrzej Hajda 	if (r < 0) {
121cac47f18SAndrzej Hajda 		dev_err(&spi->dev, "spi_setup() failed\n");
122cac47f18SAndrzej Hajda 		return r;
123cac47f18SAndrzej Hajda 	}
124cac47f18SAndrzej Hajda 
125cac47f18SAndrzej Hajda 	mutex_lock(&state->lock);
126cac47f18SAndrzej Hajda 	state->spi_dev = spi;
127cac47f18SAndrzej Hajda 	mutex_unlock(&state->lock);
128cac47f18SAndrzej Hajda 
129cac47f18SAndrzej Hajda 	v4l2_info(&state->sensor_sd, "S5C73M3 SPI probed successfully\n");
130cac47f18SAndrzej Hajda 	return 0;
131cac47f18SAndrzej Hajda }
132cac47f18SAndrzej Hajda 
s5c73m3_register_spi_driver(struct s5c73m3 * state)133cac47f18SAndrzej Hajda int s5c73m3_register_spi_driver(struct s5c73m3 *state)
134cac47f18SAndrzej Hajda {
135cac47f18SAndrzej Hajda 	struct spi_driver *spidrv = &state->spidrv;
136cac47f18SAndrzej Hajda 
137cac47f18SAndrzej Hajda 	spidrv->probe = s5c73m3_spi_probe;
138cac47f18SAndrzej Hajda 	spidrv->driver.name = S5C73M3_SPI_DRV_NAME;
139bce6744dSSylwester Nawrocki 	spidrv->driver.of_match_table = s5c73m3_spi_ids;
140cac47f18SAndrzej Hajda 
141cac47f18SAndrzej Hajda 	return spi_register_driver(spidrv);
142cac47f18SAndrzej Hajda }
143cac47f18SAndrzej Hajda 
s5c73m3_unregister_spi_driver(struct s5c73m3 * state)144cac47f18SAndrzej Hajda void s5c73m3_unregister_spi_driver(struct s5c73m3 *state)
145cac47f18SAndrzej Hajda {
146cac47f18SAndrzej Hajda 	spi_unregister_driver(&state->spidrv);
147cac47f18SAndrzej Hajda }
148