2 * Samsung LSI S5C73M3 8M pixel camera driver
4 * Copyright (C) 2012, Samsung Electronics, Co., Ltd.
5 * Sylwester Nawrocki <s.nawrocki@samsung.com>
6 * Andrzej Hajda <a.hajda@samsung.com>
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License
10 * version 2 as published by the Free Software Foundation.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
18 #include <linux/sizes.h>
19 #include <linux/delay.h>
20 #include <linux/init.h>
21 #include <linux/media.h>
22 #include <linux/module.h>
23 #include <linux/slab.h>
24 #include <linux/spi/spi.h>
28 #define S5C73M3_SPI_DRV_NAME "S5C73M3-SPI"
30 static const struct of_device_id s5c73m3_spi_ids[] = {
31 { .compatible = "samsung,s5c73m3" },
34 MODULE_DEVICE_TABLE(of, s5c73m3_spi_ids);
40 MODULE_DEVICE_TABLE(of, s5c73m3_spi_ids);
42 static int spi_xmit(struct spi_device *spi_dev, void *addr, const int len,
43 enum spi_direction dir)
45 struct spi_message msg;
47 struct spi_transfer xfer = {
51 if (dir == SPI_DIR_TX)
56 if (spi_dev == NULL) {
57 pr_err("SPI device is uninitialized\n");
61 spi_message_init(&msg);
62 spi_message_add_tail(&xfer, &msg);
64 r = spi_sync(spi_dev, &msg);
66 dev_err(&spi_dev->dev, "%s spi_sync failed %d\n", __func__, r);
71 int s5c73m3_spi_write(struct s5c73m3 *state, const void *addr,
72 const unsigned int len, const unsigned int tx_size)
74 struct spi_device *spi_dev = state->spi_dev;
75 u32 count = len / tx_size;
76 u32 extra = len % tx_size;
77 unsigned int i, j = 0;
81 memset(padding, 0, sizeof(padding));
83 for (i = 0; i < count; i++) {
84 r = spi_xmit(spi_dev, (void *)addr + j, tx_size, SPI_DIR_TX);
91 r = spi_xmit(spi_dev, (void *)addr + j, extra, SPI_DIR_TX);
96 return spi_xmit(spi_dev, padding, sizeof(padding), SPI_DIR_TX);
99 int s5c73m3_spi_read(struct s5c73m3 *state, void *addr,
100 const unsigned int len, const unsigned int tx_size)
102 struct spi_device *spi_dev = state->spi_dev;
103 u32 count = len / tx_size;
104 u32 extra = len % tx_size;
105 unsigned int i, j = 0;
108 for (i = 0; i < count; i++) {
109 r = spi_xmit(spi_dev, addr + j, tx_size, SPI_DIR_RX);
116 return spi_xmit(spi_dev, addr + j, extra, SPI_DIR_RX);
121 static int s5c73m3_spi_probe(struct spi_device *spi)
124 struct s5c73m3 *state = container_of(spi->dev.driver, struct s5c73m3,
126 spi->bits_per_word = 32;
130 dev_err(&spi->dev, "spi_setup() failed\n");
134 mutex_lock(&state->lock);
135 state->spi_dev = spi;
136 mutex_unlock(&state->lock);
138 v4l2_info(&state->sensor_sd, "S5C73M3 SPI probed successfully\n");
142 static int s5c73m3_spi_remove(struct spi_device *spi)
147 int s5c73m3_register_spi_driver(struct s5c73m3 *state)
149 struct spi_driver *spidrv = &state->spidrv;
151 spidrv->remove = s5c73m3_spi_remove;
152 spidrv->probe = s5c73m3_spi_probe;
153 spidrv->driver.name = S5C73M3_SPI_DRV_NAME;
154 spidrv->driver.of_match_table = s5c73m3_spi_ids;
156 return spi_register_driver(spidrv);
159 void s5c73m3_unregister_spi_driver(struct s5c73m3 *state)
161 spi_unregister_driver(&state->spidrv);