1
2
3
4
5
6
7
8
9
10
11
12#include <linux/init.h>
13#include <linux/mutex.h>
14#include <linux/platform_device.h>
15#include <linux/clk.h>
16#include <linux/module.h>
17#include <linux/err.h>
18#include <linux/gpio.h>
19#include <linux/leds.h>
20#include <linux/i2c.h>
21#include <linux/i2c/dm355evm_msp.h>
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36#if IS_ENABLED(CONFIG_INPUT_DM355EVM)
37#define msp_has_keyboard() true
38#else
39#define msp_has_keyboard() false
40#endif
41
42#if IS_ENABLED(CONFIG_LEDS_GPIO)
43#define msp_has_leds() true
44#else
45#define msp_has_leds() false
46#endif
47
48#if IS_ENABLED(CONFIG_RTC_DRV_DM355EVM)
49#define msp_has_rtc() true
50#else
51#define msp_has_rtc() false
52#endif
53
54#if IS_ENABLED(CONFIG_VIDEO_TVP514X)
55#define msp_has_tvp() true
56#else
57#define msp_has_tvp() false
58#endif
59
60
61
62
63
64
65static struct i2c_client *msp430;
66
67
68
69
70
71
72
73
74int dm355evm_msp_write(u8 value, u8 reg)
75{
76 return i2c_smbus_write_byte_data(msp430, reg, value);
77}
78EXPORT_SYMBOL(dm355evm_msp_write);
79
80
81
82
83
84
85
86int dm355evm_msp_read(u8 reg)
87{
88 return i2c_smbus_read_byte_data(msp430, reg);
89}
90EXPORT_SYMBOL(dm355evm_msp_read);
91
92
93
94
95
96
97
98#define MSP_GPIO(bit, reg) ((DM355EVM_MSP_ ## reg) << 3 | (bit))
99
100static const u8 msp_gpios[] = {
101
102 MSP_GPIO(0, LED), MSP_GPIO(1, LED),
103 MSP_GPIO(2, LED), MSP_GPIO(3, LED),
104 MSP_GPIO(4, LED), MSP_GPIO(5, LED),
105 MSP_GPIO(6, LED), MSP_GPIO(7, LED),
106
107 MSP_GPIO(0, SWITCH1), MSP_GPIO(1, SWITCH1),
108 MSP_GPIO(2, SWITCH1), MSP_GPIO(3, SWITCH1),
109 MSP_GPIO(4, SWITCH1),
110
111
112
113
114
115
116
117
118
119 MSP_GPIO(2, SDMMC), MSP_GPIO(1, SDMMC),
120 MSP_GPIO(4, SDMMC), MSP_GPIO(3, SDMMC),
121};
122
123#define MSP_GPIO_REG(offset) (msp_gpios[(offset)] >> 3)
124#define MSP_GPIO_MASK(offset) BIT(msp_gpios[(offset)] & 0x07)
125
126static int msp_gpio_in(struct gpio_chip *chip, unsigned offset)
127{
128 switch (MSP_GPIO_REG(offset)) {
129 case DM355EVM_MSP_SWITCH1:
130 case DM355EVM_MSP_SWITCH2:
131 case DM355EVM_MSP_SDMMC:
132 return 0;
133 default:
134 return -EINVAL;
135 }
136}
137
138static u8 msp_led_cache;
139
140static int msp_gpio_get(struct gpio_chip *chip, unsigned offset)
141{
142 int reg, status;
143
144 reg = MSP_GPIO_REG(offset);
145 status = dm355evm_msp_read(reg);
146 if (status < 0)
147 return status;
148 if (reg == DM355EVM_MSP_LED)
149 msp_led_cache = status;
150 return !!(status & MSP_GPIO_MASK(offset));
151}
152
153static int msp_gpio_out(struct gpio_chip *chip, unsigned offset, int value)
154{
155 int mask, bits;
156
157
158
159
160
161 if (MSP_GPIO_REG(offset) != DM355EVM_MSP_LED)
162 return -EINVAL;
163
164 mask = MSP_GPIO_MASK(offset);
165 bits = msp_led_cache;
166
167 bits &= ~mask;
168 if (value)
169 bits |= mask;
170 msp_led_cache = bits;
171
172 return dm355evm_msp_write(bits, DM355EVM_MSP_LED);
173}
174
175static void msp_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
176{
177 msp_gpio_out(chip, offset, value);
178}
179
180static struct gpio_chip dm355evm_msp_gpio = {
181 .label = "dm355evm_msp",
182 .owner = THIS_MODULE,
183 .direction_input = msp_gpio_in,
184 .get = msp_gpio_get,
185 .direction_output = msp_gpio_out,
186 .set = msp_gpio_set,
187 .base = -EINVAL,
188 .ngpio = ARRAY_SIZE(msp_gpios),
189 .can_sleep = true,
190};
191
192
193
194static struct device *add_child(struct i2c_client *client, const char *name,
195 void *pdata, unsigned pdata_len,
196 bool can_wakeup, int irq)
197{
198 struct platform_device *pdev;
199 int status;
200
201 pdev = platform_device_alloc(name, -1);
202 if (!pdev)
203 return ERR_PTR(-ENOMEM);
204
205 device_init_wakeup(&pdev->dev, can_wakeup);
206 pdev->dev.parent = &client->dev;
207
208 if (pdata) {
209 status = platform_device_add_data(pdev, pdata, pdata_len);
210 if (status < 0) {
211 dev_dbg(&pdev->dev, "can't add platform_data\n");
212 goto put_device;
213 }
214 }
215
216 if (irq) {
217 struct resource r = {
218 .start = irq,
219 .flags = IORESOURCE_IRQ,
220 };
221
222 status = platform_device_add_resources(pdev, &r, 1);
223 if (status < 0) {
224 dev_dbg(&pdev->dev, "can't add irq\n");
225 goto put_device;
226 }
227 }
228
229 status = platform_device_add(pdev);
230 if (status)
231 goto put_device;
232
233 return &pdev->dev;
234
235put_device:
236 platform_device_put(pdev);
237 dev_err(&client->dev, "failed to add device %s\n", name);
238 return ERR_PTR(status);
239}
240
241static int add_children(struct i2c_client *client)
242{
243 static const struct {
244 int offset;
245 char *label;
246 } config_inputs[] = {
247
248 { 8 + 0, "sw6_1", },
249 { 8 + 1, "sw6_2", },
250 { 8 + 2, "sw6_3", },
251 { 8 + 3, "sw6_4", },
252 { 8 + 4, "NTSC/nPAL", },
253 };
254
255 struct device *child;
256 int status;
257 int i;
258
259
260 dm355evm_msp_gpio.parent = &client->dev;
261 status = gpiochip_add_data(&dm355evm_msp_gpio, NULL);
262 if (status < 0)
263 return status;
264
265
266 if (msp_has_leds()) {
267#define GPIO_LED(l) .name = l, .active_low = true
268 static struct gpio_led evm_leds[] = {
269 { GPIO_LED("dm355evm::ds14"),
270 .default_trigger = "heartbeat", },
271 { GPIO_LED("dm355evm::ds15"),
272 .default_trigger = "mmc0", },
273 { GPIO_LED("dm355evm::ds16"),
274
275 .default_trigger = "mmc1", },
276 { GPIO_LED("dm355evm::ds17"),
277 .default_trigger = "nand-disk", },
278 { GPIO_LED("dm355evm::ds18"), },
279 { GPIO_LED("dm355evm::ds19"), },
280 { GPIO_LED("dm355evm::ds20"), },
281 { GPIO_LED("dm355evm::ds21"), },
282 };
283#undef GPIO_LED
284
285 struct gpio_led_platform_data evm_led_data = {
286 .num_leds = ARRAY_SIZE(evm_leds),
287 .leds = evm_leds,
288 };
289
290 for (i = 0; i < ARRAY_SIZE(evm_leds); i++)
291 evm_leds[i].gpio = i + dm355evm_msp_gpio.base;
292
293
294
295
296
297
298 child = add_child(client, "leds-gpio",
299 &evm_led_data, sizeof(evm_led_data),
300 false, 0);
301 if (IS_ERR(child))
302 return PTR_ERR(child);
303 }
304
305
306 for (i = 0; i < ARRAY_SIZE(config_inputs); i++) {
307 int gpio = dm355evm_msp_gpio.base + config_inputs[i].offset;
308
309 gpio_request_one(gpio, GPIOF_IN, config_inputs[i].label);
310
311
312 gpio_export(gpio, false);
313 }
314
315
316 if (dev_get_platdata(&client->dev)) {
317 void (*mmcsd_setup)(unsigned) = dev_get_platdata(&client->dev);
318
319 mmcsd_setup(dm355evm_msp_gpio.base + 8 + 5);
320 }
321
322
323 if (msp_has_rtc()) {
324 child = add_child(client, "rtc-dm355evm",
325 NULL, 0, false, 0);
326 if (IS_ERR(child))
327 return PTR_ERR(child);
328 }
329
330
331 if (msp_has_keyboard()) {
332 child = add_child(client, "dm355evm_keys",
333 NULL, 0, true, client->irq);
334 if (IS_ERR(child))
335 return PTR_ERR(child);
336 }
337
338 return 0;
339}
340
341
342
343static void dm355evm_command(unsigned command)
344{
345 int status;
346
347 status = dm355evm_msp_write(command, DM355EVM_MSP_COMMAND);
348 if (status < 0)
349 dev_err(&msp430->dev, "command %d failure %d\n",
350 command, status);
351}
352
353static void dm355evm_power_off(void)
354{
355 dm355evm_command(MSP_COMMAND_POWEROFF);
356}
357
358static int dm355evm_msp_remove(struct i2c_client *client)
359{
360 pm_power_off = NULL;
361 msp430 = NULL;
362 return 0;
363}
364
365static int
366dm355evm_msp_probe(struct i2c_client *client, const struct i2c_device_id *id)
367{
368 int status;
369 const char *video = msp_has_tvp() ? "TVP5146" : "imager";
370
371 if (msp430)
372 return -EBUSY;
373 msp430 = client;
374
375
376 status = dm355evm_msp_read(DM355EVM_MSP_FIRMREV);
377 if (status < 0)
378 goto fail;
379 dev_info(&client->dev, "firmware v.%02X, %s as video-in\n",
380 status, video);
381
382
383 status = dm355evm_msp_write(msp_has_tvp() ? 0 : MSP_VIDEO_IMAGER,
384 DM355EVM_MSP_VIDEO_IN);
385 if (status < 0)
386 dev_warn(&client->dev, "error %d muxing %s as video-in\n",
387 status, video);
388
389
390 msp_led_cache = 0xff;
391 dm355evm_msp_write(msp_led_cache, DM355EVM_MSP_LED);
392
393
394 status = add_children(client);
395 if (status < 0)
396 goto fail;
397
398
399 pm_power_off = dm355evm_power_off;
400
401 return 0;
402
403fail:
404
405 dm355evm_msp_remove(client);
406 return status;
407}
408
409static const struct i2c_device_id dm355evm_msp_ids[] = {
410 { "dm355evm_msp", 0 },
411 { },
412};
413MODULE_DEVICE_TABLE(i2c, dm355evm_msp_ids);
414
415static struct i2c_driver dm355evm_msp_driver = {
416 .driver.name = "dm355evm_msp",
417 .id_table = dm355evm_msp_ids,
418 .probe = dm355evm_msp_probe,
419 .remove = dm355evm_msp_remove,
420};
421
422static int __init dm355evm_msp_init(void)
423{
424 return i2c_add_driver(&dm355evm_msp_driver);
425}
426subsys_initcall(dm355evm_msp_init);
427
428static void __exit dm355evm_msp_exit(void)
429{
430 i2c_del_driver(&dm355evm_msp_driver);
431}
432module_exit(dm355evm_msp_exit);
433
434MODULE_DESCRIPTION("Interface to MSP430 firmware on DM355EVM");
435MODULE_LICENSE("GPL");
436