18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * dm355evm_msp.c - driver for MSP430 firmware on DM355EVM board
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * Copyright (C) 2008 David Brownell
68c2ecf20Sopenharmony_ci */
78c2ecf20Sopenharmony_ci
88c2ecf20Sopenharmony_ci#include <linux/init.h>
98c2ecf20Sopenharmony_ci#include <linux/mutex.h>
108c2ecf20Sopenharmony_ci#include <linux/platform_device.h>
118c2ecf20Sopenharmony_ci#include <linux/clk.h>
128c2ecf20Sopenharmony_ci#include <linux/module.h>
138c2ecf20Sopenharmony_ci#include <linux/err.h>
148c2ecf20Sopenharmony_ci#include <linux/gpio.h>
158c2ecf20Sopenharmony_ci#include <linux/gpio/machine.h>
168c2ecf20Sopenharmony_ci#include <linux/leds.h>
178c2ecf20Sopenharmony_ci#include <linux/i2c.h>
188c2ecf20Sopenharmony_ci#include <linux/mfd/dm355evm_msp.h>
198c2ecf20Sopenharmony_ci
208c2ecf20Sopenharmony_ci
218c2ecf20Sopenharmony_ci/*
228c2ecf20Sopenharmony_ci * The DM355 is a DaVinci chip with video support but no C64+ DSP.  Its
238c2ecf20Sopenharmony_ci * EVM board has an MSP430 programmed with firmware for various board
248c2ecf20Sopenharmony_ci * support functions.  This driver exposes some of them directly, and
258c2ecf20Sopenharmony_ci * supports other drivers (e.g. RTC, input) for more complex access.
268c2ecf20Sopenharmony_ci *
278c2ecf20Sopenharmony_ci * Because this firmware is entirely board-specific, this file embeds
288c2ecf20Sopenharmony_ci * knowledge that would be passed as platform_data in a generic driver.
298c2ecf20Sopenharmony_ci *
308c2ecf20Sopenharmony_ci * This driver was tested with firmware revision A4.
318c2ecf20Sopenharmony_ci */
328c2ecf20Sopenharmony_ci
338c2ecf20Sopenharmony_ci#if IS_ENABLED(CONFIG_INPUT_DM355EVM)
348c2ecf20Sopenharmony_ci#define msp_has_keyboard()	true
358c2ecf20Sopenharmony_ci#else
368c2ecf20Sopenharmony_ci#define msp_has_keyboard()	false
378c2ecf20Sopenharmony_ci#endif
388c2ecf20Sopenharmony_ci
398c2ecf20Sopenharmony_ci#if IS_ENABLED(CONFIG_LEDS_GPIO)
408c2ecf20Sopenharmony_ci#define msp_has_leds()		true
418c2ecf20Sopenharmony_ci#else
428c2ecf20Sopenharmony_ci#define msp_has_leds()		false
438c2ecf20Sopenharmony_ci#endif
448c2ecf20Sopenharmony_ci
458c2ecf20Sopenharmony_ci#if IS_ENABLED(CONFIG_RTC_DRV_DM355EVM)
468c2ecf20Sopenharmony_ci#define msp_has_rtc()		true
478c2ecf20Sopenharmony_ci#else
488c2ecf20Sopenharmony_ci#define msp_has_rtc()		false
498c2ecf20Sopenharmony_ci#endif
508c2ecf20Sopenharmony_ci
518c2ecf20Sopenharmony_ci#if IS_ENABLED(CONFIG_VIDEO_TVP514X)
528c2ecf20Sopenharmony_ci#define msp_has_tvp()		true
538c2ecf20Sopenharmony_ci#else
548c2ecf20Sopenharmony_ci#define msp_has_tvp()		false
558c2ecf20Sopenharmony_ci#endif
568c2ecf20Sopenharmony_ci
578c2ecf20Sopenharmony_ci
588c2ecf20Sopenharmony_ci/*----------------------------------------------------------------------*/
598c2ecf20Sopenharmony_ci
608c2ecf20Sopenharmony_ci/* REVISIT for paranoia's sake, retry reads/writes on error */
618c2ecf20Sopenharmony_ci
628c2ecf20Sopenharmony_cistatic struct i2c_client *msp430;
638c2ecf20Sopenharmony_ci
648c2ecf20Sopenharmony_ci/**
658c2ecf20Sopenharmony_ci * dm355evm_msp_write - Writes a register in dm355evm_msp
668c2ecf20Sopenharmony_ci * @value: the value to be written
678c2ecf20Sopenharmony_ci * @reg: register address
688c2ecf20Sopenharmony_ci *
698c2ecf20Sopenharmony_ci * Returns result of operation - 0 is success, else negative errno
708c2ecf20Sopenharmony_ci */
718c2ecf20Sopenharmony_ciint dm355evm_msp_write(u8 value, u8 reg)
728c2ecf20Sopenharmony_ci{
738c2ecf20Sopenharmony_ci	return i2c_smbus_write_byte_data(msp430, reg, value);
748c2ecf20Sopenharmony_ci}
758c2ecf20Sopenharmony_ciEXPORT_SYMBOL(dm355evm_msp_write);
768c2ecf20Sopenharmony_ci
778c2ecf20Sopenharmony_ci/**
788c2ecf20Sopenharmony_ci * dm355evm_msp_read - Reads a register from dm355evm_msp
798c2ecf20Sopenharmony_ci * @reg: register address
808c2ecf20Sopenharmony_ci *
818c2ecf20Sopenharmony_ci * Returns result of operation - value, or negative errno
828c2ecf20Sopenharmony_ci */
838c2ecf20Sopenharmony_ciint dm355evm_msp_read(u8 reg)
848c2ecf20Sopenharmony_ci{
858c2ecf20Sopenharmony_ci	return i2c_smbus_read_byte_data(msp430, reg);
868c2ecf20Sopenharmony_ci}
878c2ecf20Sopenharmony_ciEXPORT_SYMBOL(dm355evm_msp_read);
888c2ecf20Sopenharmony_ci
898c2ecf20Sopenharmony_ci/*----------------------------------------------------------------------*/
908c2ecf20Sopenharmony_ci
918c2ecf20Sopenharmony_ci/*
928c2ecf20Sopenharmony_ci * Many of the msp430 pins are just used as fixed-direction GPIOs.
938c2ecf20Sopenharmony_ci * We could export a few more of them this way, if we wanted.
948c2ecf20Sopenharmony_ci */
958c2ecf20Sopenharmony_ci#define MSP_GPIO(bit, reg)	((DM355EVM_MSP_ ## reg) << 3 | (bit))
968c2ecf20Sopenharmony_ci
978c2ecf20Sopenharmony_cistatic const u8 msp_gpios[] = {
988c2ecf20Sopenharmony_ci	/* eight leds */
998c2ecf20Sopenharmony_ci	MSP_GPIO(0, LED), MSP_GPIO(1, LED),
1008c2ecf20Sopenharmony_ci	MSP_GPIO(2, LED), MSP_GPIO(3, LED),
1018c2ecf20Sopenharmony_ci	MSP_GPIO(4, LED), MSP_GPIO(5, LED),
1028c2ecf20Sopenharmony_ci	MSP_GPIO(6, LED), MSP_GPIO(7, LED),
1038c2ecf20Sopenharmony_ci	/* SW6 and the NTSC/nPAL jumper */
1048c2ecf20Sopenharmony_ci	MSP_GPIO(0, SWITCH1), MSP_GPIO(1, SWITCH1),
1058c2ecf20Sopenharmony_ci	MSP_GPIO(2, SWITCH1), MSP_GPIO(3, SWITCH1),
1068c2ecf20Sopenharmony_ci	MSP_GPIO(4, SWITCH1),
1078c2ecf20Sopenharmony_ci	/* switches on MMC/SD sockets */
1088c2ecf20Sopenharmony_ci	/*
1098c2ecf20Sopenharmony_ci	 * Note: EVMDM355_ECP_VA4.pdf suggests that Bit 2 and 4 should be
1108c2ecf20Sopenharmony_ci	 * checked for card detection. However on the EVM bit 1 and 3 gives
1118c2ecf20Sopenharmony_ci	 * this status, for 0 and 1 instance respectively. The pdf also
1128c2ecf20Sopenharmony_ci	 * suggests that Bit 1 and 3 should be checked for write protection.
1138c2ecf20Sopenharmony_ci	 * However on the EVM bit 2 and 4 gives this status,for 0 and 1
1148c2ecf20Sopenharmony_ci	 * instance respectively.
1158c2ecf20Sopenharmony_ci	 */
1168c2ecf20Sopenharmony_ci	MSP_GPIO(2, SDMMC), MSP_GPIO(1, SDMMC),	/* mmc0 WP, nCD */
1178c2ecf20Sopenharmony_ci	MSP_GPIO(4, SDMMC), MSP_GPIO(3, SDMMC),	/* mmc1 WP, nCD */
1188c2ecf20Sopenharmony_ci};
1198c2ecf20Sopenharmony_ci
1208c2ecf20Sopenharmony_cistatic struct gpio_led evm_leds[] = {
1218c2ecf20Sopenharmony_ci	{ .name = "dm355evm::ds14",
1228c2ecf20Sopenharmony_ci	  .default_trigger = "heartbeat", },
1238c2ecf20Sopenharmony_ci	{ .name = "dm355evm::ds15",
1248c2ecf20Sopenharmony_ci	  .default_trigger = "mmc0", },
1258c2ecf20Sopenharmony_ci	{ .name = "dm355evm::ds16",
1268c2ecf20Sopenharmony_ci	  /* could also be a CE-ATA drive */
1278c2ecf20Sopenharmony_ci	  .default_trigger = "mmc1", },
1288c2ecf20Sopenharmony_ci	{ .name = "dm355evm::ds17",
1298c2ecf20Sopenharmony_ci	  .default_trigger = "nand-disk", },
1308c2ecf20Sopenharmony_ci	{ .name = "dm355evm::ds18", },
1318c2ecf20Sopenharmony_ci	{ .name = "dm355evm::ds19", },
1328c2ecf20Sopenharmony_ci	{ .name = "dm355evm::ds20", },
1338c2ecf20Sopenharmony_ci	{ .name = "dm355evm::ds21", },
1348c2ecf20Sopenharmony_ci};
1358c2ecf20Sopenharmony_ci
1368c2ecf20Sopenharmony_cistatic struct gpio_led_platform_data evm_led_data = {
1378c2ecf20Sopenharmony_ci	.num_leds	= ARRAY_SIZE(evm_leds),
1388c2ecf20Sopenharmony_ci	.leds		= evm_leds,
1398c2ecf20Sopenharmony_ci};
1408c2ecf20Sopenharmony_ci
1418c2ecf20Sopenharmony_cistatic struct gpiod_lookup_table evm_leds_gpio_table = {
1428c2ecf20Sopenharmony_ci	.dev_id = "leds-gpio",
1438c2ecf20Sopenharmony_ci	.table = {
1448c2ecf20Sopenharmony_ci		/*
1458c2ecf20Sopenharmony_ci		 * These GPIOs are on the dm355evm_msp
1468c2ecf20Sopenharmony_ci		 * GPIO chip at index 0..7
1478c2ecf20Sopenharmony_ci		 */
1488c2ecf20Sopenharmony_ci		GPIO_LOOKUP_IDX("dm355evm_msp", 0, NULL,
1498c2ecf20Sopenharmony_ci				0, GPIO_ACTIVE_LOW),
1508c2ecf20Sopenharmony_ci		GPIO_LOOKUP_IDX("dm355evm_msp", 1, NULL,
1518c2ecf20Sopenharmony_ci				1, GPIO_ACTIVE_LOW),
1528c2ecf20Sopenharmony_ci		GPIO_LOOKUP_IDX("dm355evm_msp", 2, NULL,
1538c2ecf20Sopenharmony_ci				2, GPIO_ACTIVE_LOW),
1548c2ecf20Sopenharmony_ci		GPIO_LOOKUP_IDX("dm355evm_msp", 3, NULL,
1558c2ecf20Sopenharmony_ci				3, GPIO_ACTIVE_LOW),
1568c2ecf20Sopenharmony_ci		GPIO_LOOKUP_IDX("dm355evm_msp", 4, NULL,
1578c2ecf20Sopenharmony_ci				4, GPIO_ACTIVE_LOW),
1588c2ecf20Sopenharmony_ci		GPIO_LOOKUP_IDX("dm355evm_msp", 5, NULL,
1598c2ecf20Sopenharmony_ci				5, GPIO_ACTIVE_LOW),
1608c2ecf20Sopenharmony_ci		GPIO_LOOKUP_IDX("dm355evm_msp", 6, NULL,
1618c2ecf20Sopenharmony_ci				6, GPIO_ACTIVE_LOW),
1628c2ecf20Sopenharmony_ci		GPIO_LOOKUP_IDX("dm355evm_msp", 7, NULL,
1638c2ecf20Sopenharmony_ci				7, GPIO_ACTIVE_LOW),
1648c2ecf20Sopenharmony_ci		{ },
1658c2ecf20Sopenharmony_ci	},
1668c2ecf20Sopenharmony_ci};
1678c2ecf20Sopenharmony_ci
1688c2ecf20Sopenharmony_ci#define MSP_GPIO_REG(offset)	(msp_gpios[(offset)] >> 3)
1698c2ecf20Sopenharmony_ci#define MSP_GPIO_MASK(offset)	BIT(msp_gpios[(offset)] & 0x07)
1708c2ecf20Sopenharmony_ci
1718c2ecf20Sopenharmony_cistatic int msp_gpio_in(struct gpio_chip *chip, unsigned offset)
1728c2ecf20Sopenharmony_ci{
1738c2ecf20Sopenharmony_ci	switch (MSP_GPIO_REG(offset)) {
1748c2ecf20Sopenharmony_ci	case DM355EVM_MSP_SWITCH1:
1758c2ecf20Sopenharmony_ci	case DM355EVM_MSP_SWITCH2:
1768c2ecf20Sopenharmony_ci	case DM355EVM_MSP_SDMMC:
1778c2ecf20Sopenharmony_ci		return 0;
1788c2ecf20Sopenharmony_ci	default:
1798c2ecf20Sopenharmony_ci		return -EINVAL;
1808c2ecf20Sopenharmony_ci	}
1818c2ecf20Sopenharmony_ci}
1828c2ecf20Sopenharmony_ci
1838c2ecf20Sopenharmony_cistatic u8 msp_led_cache;
1848c2ecf20Sopenharmony_ci
1858c2ecf20Sopenharmony_cistatic int msp_gpio_get(struct gpio_chip *chip, unsigned offset)
1868c2ecf20Sopenharmony_ci{
1878c2ecf20Sopenharmony_ci	int reg, status;
1888c2ecf20Sopenharmony_ci
1898c2ecf20Sopenharmony_ci	reg = MSP_GPIO_REG(offset);
1908c2ecf20Sopenharmony_ci	status = dm355evm_msp_read(reg);
1918c2ecf20Sopenharmony_ci	if (status < 0)
1928c2ecf20Sopenharmony_ci		return status;
1938c2ecf20Sopenharmony_ci	if (reg == DM355EVM_MSP_LED)
1948c2ecf20Sopenharmony_ci		msp_led_cache = status;
1958c2ecf20Sopenharmony_ci	return !!(status & MSP_GPIO_MASK(offset));
1968c2ecf20Sopenharmony_ci}
1978c2ecf20Sopenharmony_ci
1988c2ecf20Sopenharmony_cistatic int msp_gpio_out(struct gpio_chip *chip, unsigned offset, int value)
1998c2ecf20Sopenharmony_ci{
2008c2ecf20Sopenharmony_ci	int mask, bits;
2018c2ecf20Sopenharmony_ci
2028c2ecf20Sopenharmony_ci	/* NOTE:  there are some other signals that could be
2038c2ecf20Sopenharmony_ci	 * packaged as output GPIOs, but they aren't as useful
2048c2ecf20Sopenharmony_ci	 * as the LEDs ... so for now we don't.
2058c2ecf20Sopenharmony_ci	 */
2068c2ecf20Sopenharmony_ci	if (MSP_GPIO_REG(offset) != DM355EVM_MSP_LED)
2078c2ecf20Sopenharmony_ci		return -EINVAL;
2088c2ecf20Sopenharmony_ci
2098c2ecf20Sopenharmony_ci	mask = MSP_GPIO_MASK(offset);
2108c2ecf20Sopenharmony_ci	bits = msp_led_cache;
2118c2ecf20Sopenharmony_ci
2128c2ecf20Sopenharmony_ci	bits &= ~mask;
2138c2ecf20Sopenharmony_ci	if (value)
2148c2ecf20Sopenharmony_ci		bits |= mask;
2158c2ecf20Sopenharmony_ci	msp_led_cache = bits;
2168c2ecf20Sopenharmony_ci
2178c2ecf20Sopenharmony_ci	return dm355evm_msp_write(bits, DM355EVM_MSP_LED);
2188c2ecf20Sopenharmony_ci}
2198c2ecf20Sopenharmony_ci
2208c2ecf20Sopenharmony_cistatic void msp_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
2218c2ecf20Sopenharmony_ci{
2228c2ecf20Sopenharmony_ci	msp_gpio_out(chip, offset, value);
2238c2ecf20Sopenharmony_ci}
2248c2ecf20Sopenharmony_ci
2258c2ecf20Sopenharmony_cistatic struct gpio_chip dm355evm_msp_gpio = {
2268c2ecf20Sopenharmony_ci	.label			= "dm355evm_msp",
2278c2ecf20Sopenharmony_ci	.owner			= THIS_MODULE,
2288c2ecf20Sopenharmony_ci	.direction_input	= msp_gpio_in,
2298c2ecf20Sopenharmony_ci	.get			= msp_gpio_get,
2308c2ecf20Sopenharmony_ci	.direction_output	= msp_gpio_out,
2318c2ecf20Sopenharmony_ci	.set			= msp_gpio_set,
2328c2ecf20Sopenharmony_ci	.base			= -EINVAL,		/* dynamic assignment */
2338c2ecf20Sopenharmony_ci	.ngpio			= ARRAY_SIZE(msp_gpios),
2348c2ecf20Sopenharmony_ci	.can_sleep		= true,
2358c2ecf20Sopenharmony_ci};
2368c2ecf20Sopenharmony_ci
2378c2ecf20Sopenharmony_ci/*----------------------------------------------------------------------*/
2388c2ecf20Sopenharmony_ci
2398c2ecf20Sopenharmony_cistatic struct device *add_child(struct i2c_client *client, const char *name,
2408c2ecf20Sopenharmony_ci		void *pdata, unsigned pdata_len,
2418c2ecf20Sopenharmony_ci		bool can_wakeup, int irq)
2428c2ecf20Sopenharmony_ci{
2438c2ecf20Sopenharmony_ci	struct platform_device	*pdev;
2448c2ecf20Sopenharmony_ci	int			status;
2458c2ecf20Sopenharmony_ci
2468c2ecf20Sopenharmony_ci	pdev = platform_device_alloc(name, -1);
2478c2ecf20Sopenharmony_ci	if (!pdev)
2488c2ecf20Sopenharmony_ci		return ERR_PTR(-ENOMEM);
2498c2ecf20Sopenharmony_ci
2508c2ecf20Sopenharmony_ci	device_init_wakeup(&pdev->dev, can_wakeup);
2518c2ecf20Sopenharmony_ci	pdev->dev.parent = &client->dev;
2528c2ecf20Sopenharmony_ci
2538c2ecf20Sopenharmony_ci	if (pdata) {
2548c2ecf20Sopenharmony_ci		status = platform_device_add_data(pdev, pdata, pdata_len);
2558c2ecf20Sopenharmony_ci		if (status < 0) {
2568c2ecf20Sopenharmony_ci			dev_dbg(&pdev->dev, "can't add platform_data\n");
2578c2ecf20Sopenharmony_ci			goto put_device;
2588c2ecf20Sopenharmony_ci		}
2598c2ecf20Sopenharmony_ci	}
2608c2ecf20Sopenharmony_ci
2618c2ecf20Sopenharmony_ci	if (irq) {
2628c2ecf20Sopenharmony_ci		struct resource r = {
2638c2ecf20Sopenharmony_ci			.start = irq,
2648c2ecf20Sopenharmony_ci			.flags = IORESOURCE_IRQ,
2658c2ecf20Sopenharmony_ci		};
2668c2ecf20Sopenharmony_ci
2678c2ecf20Sopenharmony_ci		status = platform_device_add_resources(pdev, &r, 1);
2688c2ecf20Sopenharmony_ci		if (status < 0) {
2698c2ecf20Sopenharmony_ci			dev_dbg(&pdev->dev, "can't add irq\n");
2708c2ecf20Sopenharmony_ci			goto put_device;
2718c2ecf20Sopenharmony_ci		}
2728c2ecf20Sopenharmony_ci	}
2738c2ecf20Sopenharmony_ci
2748c2ecf20Sopenharmony_ci	status = platform_device_add(pdev);
2758c2ecf20Sopenharmony_ci	if (status)
2768c2ecf20Sopenharmony_ci		goto put_device;
2778c2ecf20Sopenharmony_ci
2788c2ecf20Sopenharmony_ci	return &pdev->dev;
2798c2ecf20Sopenharmony_ci
2808c2ecf20Sopenharmony_ciput_device:
2818c2ecf20Sopenharmony_ci	platform_device_put(pdev);
2828c2ecf20Sopenharmony_ci	dev_err(&client->dev, "failed to add device %s\n", name);
2838c2ecf20Sopenharmony_ci	return ERR_PTR(status);
2848c2ecf20Sopenharmony_ci}
2858c2ecf20Sopenharmony_ci
2868c2ecf20Sopenharmony_cistatic int add_children(struct i2c_client *client)
2878c2ecf20Sopenharmony_ci{
2888c2ecf20Sopenharmony_ci	static const struct {
2898c2ecf20Sopenharmony_ci		int offset;
2908c2ecf20Sopenharmony_ci		char *label;
2918c2ecf20Sopenharmony_ci	} config_inputs[] = {
2928c2ecf20Sopenharmony_ci		/* 8 == right after the LEDs */
2938c2ecf20Sopenharmony_ci		{ 8 + 0, "sw6_1", },
2948c2ecf20Sopenharmony_ci		{ 8 + 1, "sw6_2", },
2958c2ecf20Sopenharmony_ci		{ 8 + 2, "sw6_3", },
2968c2ecf20Sopenharmony_ci		{ 8 + 3, "sw6_4", },
2978c2ecf20Sopenharmony_ci		{ 8 + 4, "NTSC/nPAL", },
2988c2ecf20Sopenharmony_ci	};
2998c2ecf20Sopenharmony_ci
3008c2ecf20Sopenharmony_ci	struct device	*child;
3018c2ecf20Sopenharmony_ci	int		status;
3028c2ecf20Sopenharmony_ci	int		i;
3038c2ecf20Sopenharmony_ci
3048c2ecf20Sopenharmony_ci	/* GPIO-ish stuff */
3058c2ecf20Sopenharmony_ci	dm355evm_msp_gpio.parent = &client->dev;
3068c2ecf20Sopenharmony_ci	status = gpiochip_add_data(&dm355evm_msp_gpio, NULL);
3078c2ecf20Sopenharmony_ci	if (status < 0)
3088c2ecf20Sopenharmony_ci		return status;
3098c2ecf20Sopenharmony_ci
3108c2ecf20Sopenharmony_ci	/* LED output */
3118c2ecf20Sopenharmony_ci	if (msp_has_leds()) {
3128c2ecf20Sopenharmony_ci		gpiod_add_lookup_table(&evm_leds_gpio_table);
3138c2ecf20Sopenharmony_ci		/* NOTE:  these are the only fully programmable LEDs
3148c2ecf20Sopenharmony_ci		 * on the board, since GPIO-61/ds22 (and many signals
3158c2ecf20Sopenharmony_ci		 * going to DC7) must be used for AEMIF address lines
3168c2ecf20Sopenharmony_ci		 * unless the top 1 GB of NAND is unused...
3178c2ecf20Sopenharmony_ci		 */
3188c2ecf20Sopenharmony_ci		child = add_child(client, "leds-gpio",
3198c2ecf20Sopenharmony_ci				&evm_led_data, sizeof(evm_led_data),
3208c2ecf20Sopenharmony_ci				false, 0);
3218c2ecf20Sopenharmony_ci		if (IS_ERR(child))
3228c2ecf20Sopenharmony_ci			return PTR_ERR(child);
3238c2ecf20Sopenharmony_ci	}
3248c2ecf20Sopenharmony_ci
3258c2ecf20Sopenharmony_ci	/* configuration inputs */
3268c2ecf20Sopenharmony_ci	for (i = 0; i < ARRAY_SIZE(config_inputs); i++) {
3278c2ecf20Sopenharmony_ci		int gpio = dm355evm_msp_gpio.base + config_inputs[i].offset;
3288c2ecf20Sopenharmony_ci
3298c2ecf20Sopenharmony_ci		gpio_request_one(gpio, GPIOF_IN, config_inputs[i].label);
3308c2ecf20Sopenharmony_ci
3318c2ecf20Sopenharmony_ci		/* make it easy for userspace to see these */
3328c2ecf20Sopenharmony_ci		gpio_export(gpio, false);
3338c2ecf20Sopenharmony_ci	}
3348c2ecf20Sopenharmony_ci
3358c2ecf20Sopenharmony_ci	/* MMC/SD inputs -- right after the last config input */
3368c2ecf20Sopenharmony_ci	if (dev_get_platdata(&client->dev)) {
3378c2ecf20Sopenharmony_ci		void (*mmcsd_setup)(unsigned) = dev_get_platdata(&client->dev);
3388c2ecf20Sopenharmony_ci
3398c2ecf20Sopenharmony_ci		mmcsd_setup(dm355evm_msp_gpio.base + 8 + 5);
3408c2ecf20Sopenharmony_ci	}
3418c2ecf20Sopenharmony_ci
3428c2ecf20Sopenharmony_ci	/* RTC is a 32 bit counter, no alarm */
3438c2ecf20Sopenharmony_ci	if (msp_has_rtc()) {
3448c2ecf20Sopenharmony_ci		child = add_child(client, "rtc-dm355evm",
3458c2ecf20Sopenharmony_ci				NULL, 0, false, 0);
3468c2ecf20Sopenharmony_ci		if (IS_ERR(child))
3478c2ecf20Sopenharmony_ci			return PTR_ERR(child);
3488c2ecf20Sopenharmony_ci	}
3498c2ecf20Sopenharmony_ci
3508c2ecf20Sopenharmony_ci	/* input from buttons and IR remote (uses the IRQ) */
3518c2ecf20Sopenharmony_ci	if (msp_has_keyboard()) {
3528c2ecf20Sopenharmony_ci		child = add_child(client, "dm355evm_keys",
3538c2ecf20Sopenharmony_ci				NULL, 0, true, client->irq);
3548c2ecf20Sopenharmony_ci		if (IS_ERR(child))
3558c2ecf20Sopenharmony_ci			return PTR_ERR(child);
3568c2ecf20Sopenharmony_ci	}
3578c2ecf20Sopenharmony_ci
3588c2ecf20Sopenharmony_ci	return 0;
3598c2ecf20Sopenharmony_ci}
3608c2ecf20Sopenharmony_ci
3618c2ecf20Sopenharmony_ci/*----------------------------------------------------------------------*/
3628c2ecf20Sopenharmony_ci
3638c2ecf20Sopenharmony_cistatic void dm355evm_command(unsigned command)
3648c2ecf20Sopenharmony_ci{
3658c2ecf20Sopenharmony_ci	int status;
3668c2ecf20Sopenharmony_ci
3678c2ecf20Sopenharmony_ci	status = dm355evm_msp_write(command, DM355EVM_MSP_COMMAND);
3688c2ecf20Sopenharmony_ci	if (status < 0)
3698c2ecf20Sopenharmony_ci		dev_err(&msp430->dev, "command %d failure %d\n",
3708c2ecf20Sopenharmony_ci				command, status);
3718c2ecf20Sopenharmony_ci}
3728c2ecf20Sopenharmony_ci
3738c2ecf20Sopenharmony_cistatic void dm355evm_power_off(void)
3748c2ecf20Sopenharmony_ci{
3758c2ecf20Sopenharmony_ci	dm355evm_command(MSP_COMMAND_POWEROFF);
3768c2ecf20Sopenharmony_ci}
3778c2ecf20Sopenharmony_ci
3788c2ecf20Sopenharmony_cistatic int dm355evm_msp_remove(struct i2c_client *client)
3798c2ecf20Sopenharmony_ci{
3808c2ecf20Sopenharmony_ci	pm_power_off = NULL;
3818c2ecf20Sopenharmony_ci	msp430 = NULL;
3828c2ecf20Sopenharmony_ci	return 0;
3838c2ecf20Sopenharmony_ci}
3848c2ecf20Sopenharmony_ci
3858c2ecf20Sopenharmony_cistatic int
3868c2ecf20Sopenharmony_cidm355evm_msp_probe(struct i2c_client *client, const struct i2c_device_id *id)
3878c2ecf20Sopenharmony_ci{
3888c2ecf20Sopenharmony_ci	int		status;
3898c2ecf20Sopenharmony_ci	const char	*video = msp_has_tvp() ? "TVP5146" : "imager";
3908c2ecf20Sopenharmony_ci
3918c2ecf20Sopenharmony_ci	if (msp430)
3928c2ecf20Sopenharmony_ci		return -EBUSY;
3938c2ecf20Sopenharmony_ci	msp430 = client;
3948c2ecf20Sopenharmony_ci
3958c2ecf20Sopenharmony_ci	/* display revision status; doubles as sanity check */
3968c2ecf20Sopenharmony_ci	status = dm355evm_msp_read(DM355EVM_MSP_FIRMREV);
3978c2ecf20Sopenharmony_ci	if (status < 0)
3988c2ecf20Sopenharmony_ci		goto fail;
3998c2ecf20Sopenharmony_ci	dev_info(&client->dev, "firmware v.%02X, %s as video-in\n",
4008c2ecf20Sopenharmony_ci			status, video);
4018c2ecf20Sopenharmony_ci
4028c2ecf20Sopenharmony_ci	/* mux video input:  either tvp5146 or some external imager */
4038c2ecf20Sopenharmony_ci	status = dm355evm_msp_write(msp_has_tvp() ? 0 : MSP_VIDEO_IMAGER,
4048c2ecf20Sopenharmony_ci			DM355EVM_MSP_VIDEO_IN);
4058c2ecf20Sopenharmony_ci	if (status < 0)
4068c2ecf20Sopenharmony_ci		dev_warn(&client->dev, "error %d muxing %s as video-in\n",
4078c2ecf20Sopenharmony_ci			status, video);
4088c2ecf20Sopenharmony_ci
4098c2ecf20Sopenharmony_ci	/* init LED cache, and turn off the LEDs */
4108c2ecf20Sopenharmony_ci	msp_led_cache = 0xff;
4118c2ecf20Sopenharmony_ci	dm355evm_msp_write(msp_led_cache, DM355EVM_MSP_LED);
4128c2ecf20Sopenharmony_ci
4138c2ecf20Sopenharmony_ci	/* export capabilities we support */
4148c2ecf20Sopenharmony_ci	status = add_children(client);
4158c2ecf20Sopenharmony_ci	if (status < 0)
4168c2ecf20Sopenharmony_ci		goto fail;
4178c2ecf20Sopenharmony_ci
4188c2ecf20Sopenharmony_ci	/* PM hookup */
4198c2ecf20Sopenharmony_ci	pm_power_off = dm355evm_power_off;
4208c2ecf20Sopenharmony_ci
4218c2ecf20Sopenharmony_ci	return 0;
4228c2ecf20Sopenharmony_ci
4238c2ecf20Sopenharmony_cifail:
4248c2ecf20Sopenharmony_ci	/* FIXME remove children ... */
4258c2ecf20Sopenharmony_ci	dm355evm_msp_remove(client);
4268c2ecf20Sopenharmony_ci	return status;
4278c2ecf20Sopenharmony_ci}
4288c2ecf20Sopenharmony_ci
4298c2ecf20Sopenharmony_cistatic const struct i2c_device_id dm355evm_msp_ids[] = {
4308c2ecf20Sopenharmony_ci	{ "dm355evm_msp", 0 },
4318c2ecf20Sopenharmony_ci	{ /* end of list */ },
4328c2ecf20Sopenharmony_ci};
4338c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(i2c, dm355evm_msp_ids);
4348c2ecf20Sopenharmony_ci
4358c2ecf20Sopenharmony_cistatic struct i2c_driver dm355evm_msp_driver = {
4368c2ecf20Sopenharmony_ci	.driver.name	= "dm355evm_msp",
4378c2ecf20Sopenharmony_ci	.id_table	= dm355evm_msp_ids,
4388c2ecf20Sopenharmony_ci	.probe		= dm355evm_msp_probe,
4398c2ecf20Sopenharmony_ci	.remove		= dm355evm_msp_remove,
4408c2ecf20Sopenharmony_ci};
4418c2ecf20Sopenharmony_ci
4428c2ecf20Sopenharmony_cistatic int __init dm355evm_msp_init(void)
4438c2ecf20Sopenharmony_ci{
4448c2ecf20Sopenharmony_ci	return i2c_add_driver(&dm355evm_msp_driver);
4458c2ecf20Sopenharmony_ci}
4468c2ecf20Sopenharmony_cisubsys_initcall(dm355evm_msp_init);
4478c2ecf20Sopenharmony_ci
4488c2ecf20Sopenharmony_cistatic void __exit dm355evm_msp_exit(void)
4498c2ecf20Sopenharmony_ci{
4508c2ecf20Sopenharmony_ci	i2c_del_driver(&dm355evm_msp_driver);
4518c2ecf20Sopenharmony_ci}
4528c2ecf20Sopenharmony_cimodule_exit(dm355evm_msp_exit);
4538c2ecf20Sopenharmony_ci
4548c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("Interface to MSP430 firmware on DM355EVM");
4558c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL");
456