[linux-2.6-block.git] / drivers / mfd / ipaq-micro.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Compaq iPAQ h3xxx Atmel microcontroller companion support
 *
 * This is an Atmel AT90LS8535 with a special flashed-in firmware that
 * implements the special protocol used by this driver.
 *
 * based on previous kernel 2.4 version by Andrew Christian
 * Author : Alessandro Gardich <gremlin@gremlin.it>
 * Author : Dmitry Artamonow <mad_soft@inbox.ru>
 * Author : Linus Walleij <linus.walleij@linaro.org>
 */

#include <linux/module.h>
#include <linux/init.h>
#include <linux/interrupt.h>
#include <linux/pm.h>
#include <linux/delay.h>
#include <linux/device.h>
#include <linux/platform_device.h>
#include <linux/io.h>
#include <linux/mfd/core.h>
#include <linux/mfd/ipaq-micro.h>
#include <linux/string.h>
#include <linux/random.h>
#include <linux/slab.h>
#include <linux/list.h>

#include <mach/hardware.h>

static void ipaq_micro_trigger_tx(struct ipaq_micro *micro)
{
	struct ipaq_micro_txdev *tx = &micro->tx;
	struct ipaq_micro_msg *msg = micro->msg;
	int i, bp;
	u8 checksum;
	u32 val;

	bp = 0;
	tx->buf[bp++] = CHAR_SOF;

	checksum = ((msg->id & 0x0f) << 4) | (msg->tx_len & 0x0f);
	tx->buf[bp++] = checksum;

	for (i = 0; i < msg->tx_len; i++) {
		tx->buf[bp++] = msg->tx_data[i];
		checksum += msg->tx_data[i];
	}

	tx->buf[bp++] = checksum;
	tx->len = bp;
	tx->index = 0;

	/* Enable interrupt */
	val = readl(micro->base + UTCR3);
	val |= UTCR3_TIE;
	writel(val, micro->base + UTCR3);
}

int ipaq_micro_tx_msg(struct ipaq_micro *micro, struct ipaq_micro_msg *msg)
{
	unsigned long flags;

	dev_dbg(micro->dev, "TX msg: %02x, %d bytes\n", msg->id, msg->tx_len);

	spin_lock_irqsave(&micro->lock, flags);
	if (micro->msg) {
		list_add_tail(&msg->node, &micro->queue);
		spin_unlock_irqrestore(&micro->lock, flags);
		return 0;
	}
	micro->msg = msg;
	ipaq_micro_trigger_tx(micro);
	spin_unlock_irqrestore(&micro->lock, flags);
	return 0;
}
EXPORT_SYMBOL(ipaq_micro_tx_msg);

static void micro_rx_msg(struct ipaq_micro *micro, u8 id, int len, u8 *data)
{
	int i;

	dev_dbg(micro->dev, "RX msg: %02x, %d bytes\n", id, len);

	spin_lock(&micro->lock);
	switch (id) {
	case MSG_VERSION:
	case MSG_EEPROM_READ:
	case MSG_EEPROM_WRITE:
	case MSG_BACKLIGHT:
	case MSG_NOTIFY_LED:
	case MSG_THERMAL_SENSOR:
	case MSG_BATTERY:
		/* Handle synchronous messages */
		if (micro->msg && micro->msg->id == id) {
			struct ipaq_micro_msg *msg = micro->msg;

			memcpy(msg->rx_data, data, len);
			msg->rx_len = len;
			complete(&micro->msg->ack);
			if (!list_empty(&micro->queue)) {
				micro->msg = list_entry(micro->queue.next,
							struct ipaq_micro_msg,
							node);
				list_del_init(&micro->msg->node);
				ipaq_micro_trigger_tx(micro);
			} else
				micro->msg = NULL;
			dev_dbg(micro->dev, "OK RX message 0x%02x\n", id);
		} else {
			dev_err(micro->dev,
				"out of band RX message 0x%02x\n", id);
			if (!micro->msg)
				dev_info(micro->dev, "no message queued\n");
			else
				dev_info(micro->dev, "expected message %02x\n",
					 micro->msg->id);
		}
		break;
	case MSG_KEYBOARD:
		if (micro->key)
			micro->key(micro->key_data, len, data);
		else
			dev_dbg(micro->dev, "key message ignored, no handle\n");
		break;
	case MSG_TOUCHSCREEN:
		if (micro->ts)
			micro->ts(micro->ts_data, len, data);
		else
			dev_dbg(micro->dev, "touchscreen message ignored, no handle\n");
		break;
	default:
		dev_err(micro->dev,
			"unknown msg %d [%d] ", id, len);
		for (i = 0; i < len; ++i)
			pr_cont("0x%02x ", data[i]);
		pr_cont("\n");
	}
	spin_unlock(&micro->lock);
}

static void micro_process_char(struct ipaq_micro *micro, u8 ch)
{
	struct ipaq_micro_rxdev *rx = &micro->rx;

	switch (rx->state) {
	case STATE_SOF:	/* Looking for SOF */
		if (ch == CHAR_SOF)
			rx->state = STATE_ID; /* Next byte is the id and len */
		break;
	case STATE_ID: /* Looking for id and len byte */
		rx->id = (ch & 0xf0) >> 4;
		rx->len = (ch & 0x0f);
		rx->index = 0;
		rx->chksum = ch;
		rx->state = (rx->len > 0) ? STATE_DATA : STATE_CHKSUM;
		break;
	case STATE_DATA: /* Looking for 'len' data bytes */
		rx->chksum += ch;
		rx->buf[rx->index] = ch;
		if (++rx->index == rx->len)
			rx->state = STATE_CHKSUM;
		break;
	case STATE_CHKSUM: /* Looking for the checksum */
		if (ch == rx->chksum)
			micro_rx_msg(micro, rx->id, rx->len, rx->buf);
		rx->state = STATE_SOF;
		break;
	}
}

static void micro_rx_chars(struct ipaq_micro *micro)
{
	u32 status, ch;

	while ((status = readl(micro->base + UTSR1)) & UTSR1_RNE) {
		ch = readl(micro->base + UTDR);
		if (status & UTSR1_PRE)
			dev_err(micro->dev, "rx: parity error\n");
		else if (status & UTSR1_FRE)
			dev_err(micro->dev, "rx: framing error\n");
		else if (status & UTSR1_ROR)
			dev_err(micro->dev, "rx: overrun error\n");
		micro_process_char(micro, ch);
	}
}

static void ipaq_micro_get_version(struct ipaq_micro *micro)
{
	struct ipaq_micro_msg msg = {
		.id = MSG_VERSION,
	};

	ipaq_micro_tx_msg_sync(micro, &msg);
	if (msg.rx_len == 4) {
		memcpy(micro->version, msg.rx_data, 4);
		micro->version[4] = '\0';
	} else if (msg.rx_len == 9) {
		memcpy(micro->version, msg.rx_data, 4);
		micro->version[4] = '\0';
		/* Bytes 4-7 are "pack", byte 8 is "boot type" */
	} else {
		dev_err(micro->dev,
			"illegal version message %d bytes\n", msg.rx_len);
	}
}

static void ipaq_micro_eeprom_read(struct ipaq_micro *micro,
				   u8 address, u8 len, u8 *data)
{
	struct ipaq_micro_msg msg = {
		.id = MSG_EEPROM_READ,
	};
	u8 i;

	for (i = 0; i < len; i++) {
		msg.tx_data[0] = address + i;
		msg.tx_data[1] = 1;
		msg.tx_len = 2;
		ipaq_micro_tx_msg_sync(micro, &msg);
		memcpy(data + (i * 2), msg.rx_data, 2);
	}
}

static char *ipaq_micro_str(u8 *wchar, u8 len)
{
	char retstr[256];
	u8 i;

	for (i = 0; i < len / 2; i++)
		retstr[i] = wchar[i * 2];
	return kstrdup(retstr, GFP_KERNEL);
}

static u16 ipaq_micro_to_u16(u8 *data)
{
	return data[1] << 8 | data[0];
}

static void __init ipaq_micro_eeprom_dump(struct ipaq_micro *micro)
{
	u8 dump[256];
	char *str;

	ipaq_micro_eeprom_read(micro, 0, 128, dump);
	str = ipaq_micro_str(dump, 10);
	if (str) {
		dev_info(micro->dev, "HW version %s\n", str);
		kfree(str);
	}
	str = ipaq_micro_str(dump+10, 40);
	if (str) {
		dev_info(micro->dev, "serial number: %s\n", str);
		/* Feed the random pool with this */
		add_device_randomness(str, strlen(str));
		kfree(str);
	}
	str = ipaq_micro_str(dump+50, 20);
	if (str) {
		dev_info(micro->dev, "module ID: %s\n", str);
		kfree(str);
	}
	str = ipaq_micro_str(dump+70, 10);
	if (str) {
		dev_info(micro->dev, "product revision: %s\n", str);
		kfree(str);
	}
	dev_info(micro->dev, "product ID: %u\n", ipaq_micro_to_u16(dump+80));
	dev_info(micro->dev, "frame rate: %u fps\n",
		 ipaq_micro_to_u16(dump+82));
	dev_info(micro->dev, "page mode: %u\n", ipaq_micro_to_u16(dump+84));
	dev_info(micro->dev, "country ID: %u\n", ipaq_micro_to_u16(dump+86));
	dev_info(micro->dev, "color display: %s\n",
		 ipaq_micro_to_u16(dump+88) ? "yes" : "no");
	dev_info(micro->dev, "ROM size: %u MiB\n", ipaq_micro_to_u16(dump+90));
	dev_info(micro->dev, "RAM size: %u KiB\n", ipaq_micro_to_u16(dump+92));
	dev_info(micro->dev, "screen: %u x %u\n",
		 ipaq_micro_to_u16(dump+94), ipaq_micro_to_u16(dump+96));
}

static void micro_tx_chars(struct ipaq_micro *micro)
{
	struct ipaq_micro_txdev *tx = &micro->tx;
	u32 val;

	while ((tx->index < tx->len) &&
	       (readl(micro->base + UTSR1) & UTSR1_TNF)) {
		writel(tx->buf[tx->index], micro->base + UTDR);
		tx->index++;
	}

	/* Stop interrupts */
	val = readl(micro->base + UTCR3);
	val &= ~UTCR3_TIE;
	writel(val, micro->base + UTCR3);
}

static void micro_reset_comm(struct ipaq_micro *micro)
{
	struct ipaq_micro_rxdev *rx = &micro->rx;
	u32 val;

	if (micro->msg)
		complete(&micro->msg->ack);

	/* Initialize Serial channel protocol frame */
	rx->state = STATE_SOF;  /* Reset the state machine */

	/* Set up interrupts */
	writel(0x01, micro->sdlc + 0x0); /* Select UART mode */

	/* Clean up CR3 */
	writel(0x0, micro->base + UTCR3);

	/* Format: 8N1 */
	writel(UTCR0_8BitData | UTCR0_1StpBit, micro->base + UTCR0);

	/* Baud rate: 115200 */
	writel(0x0, micro->base + UTCR1);
	writel(0x1, micro->base + UTCR2);

	/* Clear SR0 */
	writel(0xff, micro->base + UTSR0);

	/* Enable RX int, disable TX int */
	writel(UTCR3_TXE | UTCR3_RXE | UTCR3_RIE, micro->base + UTCR3);
	val = readl(micro->base + UTCR3);
	val &= ~UTCR3_TIE;
	writel(val, micro->base + UTCR3);
}

static irqreturn_t micro_serial_isr(int irq, void *dev_id)
{
	struct ipaq_micro *micro = dev_id;
	struct ipaq_micro_txdev *tx = &micro->tx;
	u32 status;

	status = readl(micro->base + UTSR0);
	do {
		if (status & (UTSR0_RID | UTSR0_RFS)) {
			if (status & UTSR0_RID)
				/* Clear the Receiver IDLE bit */
				writel(UTSR0_RID, micro->base + UTSR0);
			micro_rx_chars(micro);
		}

		/* Clear break bits */
		if (status & (UTSR0_RBB | UTSR0_REB))
			writel(status & (UTSR0_RBB | UTSR0_REB),
			       micro->base + UTSR0);

		if (status & UTSR0_TFS)
			micro_tx_chars(micro);

		status = readl(micro->base + UTSR0);

	} while (((tx->index < tx->len) && (status & UTSR0_TFS)) ||
		 (status & (UTSR0_RFS | UTSR0_RID)));

	return IRQ_HANDLED;
}

static const struct mfd_cell micro_cells[] = {
	{ .name = "ipaq-micro-backlight", },
	{ .name = "ipaq-micro-battery", },
	{ .name = "ipaq-micro-keys", },
	{ .name = "ipaq-micro-ts", },
	{ .name = "ipaq-micro-leds", },
};

static int __maybe_unused micro_resume(struct device *dev)
{
	struct ipaq_micro *micro = dev_get_drvdata(dev);

	micro_reset_comm(micro);
	mdelay(10);

	return 0;
}

static int __init micro_probe(struct platform_device *pdev)
{
	struct ipaq_micro *micro;
	struct resource *res;
	int ret;
	int irq;

	micro = devm_kzalloc(&pdev->dev, sizeof(*micro), GFP_KERNEL);
	if (!micro)
		return -ENOMEM;

	micro->dev = &pdev->dev;

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	micro->base = devm_ioremap_resource(&pdev->dev, res);
	if (IS_ERR(micro->base))
		return PTR_ERR(micro->base);

	res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
	if (!res)
		return -EINVAL;

	micro->sdlc = devm_ioremap_resource(&pdev->dev, res);
	if (IS_ERR(micro->sdlc))
		return PTR_ERR(micro->sdlc);

	micro_reset_comm(micro);

	irq = platform_get_irq(pdev, 0);
	if (!irq)
		return -EINVAL;
	ret = devm_request_irq(&pdev->dev, irq, micro_serial_isr,
			       IRQF_SHARED, "ipaq-micro",
			       micro);
	if (ret) {
		dev_err(&pdev->dev, "unable to grab serial port IRQ\n");
		return ret;
	} else
		dev_info(&pdev->dev, "grabbed serial port IRQ\n");

	spin_lock_init(&micro->lock);
	INIT_LIST_HEAD(&micro->queue);
	platform_set_drvdata(pdev, micro);

	ret = mfd_add_devices(&pdev->dev, pdev->id, micro_cells,
			      ARRAY_SIZE(micro_cells), NULL, 0, NULL);
	if (ret) {
		dev_err(&pdev->dev, "error adding MFD cells");
		return ret;
	}

	/* Check version */
	ipaq_micro_get_version(micro);
	dev_info(&pdev->dev, "Atmel micro ASIC version %s\n", micro->version);
	ipaq_micro_eeprom_dump(micro);

	return 0;
}

static const struct dev_pm_ops micro_dev_pm_ops = {
	SET_SYSTEM_SLEEP_PM_OPS(NULL, micro_resume)
};

static struct platform_driver micro_device_driver = {
	.driver   = {
		.name	= "ipaq-h3xxx-micro",
		.pm	= &micro_dev_pm_ops,
		.suppress_bind_attrs = true,
	},
};
builtin_platform_driver_probe(micro_device_driver, micro_probe);
Commit	Line	Data
d2912cb1	1	// SPDX-License-Identifier: GPL-2.0-only
dcc21cc0 LW	2	/*
	3	* Compaq iPAQ h3xxx Atmel microcontroller companion support
	4	*
	5	* This is an Atmel AT90LS8535 with a special flashed-in firmware that
	6	* implements the special protocol used by this driver.
	7	*
	8	* based on previous kernel 2.4 version by Andrew Christian
	9	* Author : Alessandro Gardich <gremlin@gremlin.it>
	10	* Author : Dmitry Artamonow <mad_soft@inbox.ru>
	11	* Author : Linus Walleij <linus.walleij@linaro.org>
dcc21cc0 LW	12	*/
	13
	14	#include <linux/module.h>
	15	#include <linux/init.h>
	16	#include <linux/interrupt.h>
	17	#include <linux/pm.h>
	18	#include <linux/delay.h>
	19	#include <linux/device.h>
	20	#include <linux/platform_device.h>
	21	#include <linux/io.h>
	22	#include <linux/mfd/core.h>
	23	#include <linux/mfd/ipaq-micro.h>
	24	#include <linux/string.h>
	25	#include <linux/random.h>
	26	#include <linux/slab.h>
	27	#include <linux/list.h>
	28
	29	#include <mach/hardware.h>
	30
	31	static void ipaq_micro_trigger_tx(struct ipaq_micro *micro)
	32	{
	33	struct ipaq_micro_txdev *tx = &micro->tx;
	34	struct ipaq_micro_msg *msg = micro->msg;
	35	int i, bp;
	36	u8 checksum;
	37	u32 val;
	38
	39	bp = 0;
	40	tx->buf[bp++] = CHAR_SOF;
	41
	42	checksum = ((msg->id & 0x0f) << 4) \| (msg->tx_len & 0x0f);
	43	tx->buf[bp++] = checksum;
	44
	45	for (i = 0; i < msg->tx_len; i++) {
	46	tx->buf[bp++] = msg->tx_data[i];
	47	checksum += msg->tx_data[i];
	48	}
	49
	50	tx->buf[bp++] = checksum;
	51	tx->len = bp;
	52	tx->index = 0;
dcc21cc0 LW	53
	54	/* Enable interrupt */
	55	val = readl(micro->base + UTCR3);
	56	val \|= UTCR3_TIE;
	57	writel(val, micro->base + UTCR3);
	58	}
	59
	60	int ipaq_micro_tx_msg(struct ipaq_micro micro, struct ipaq_micro_msg msg)
	61	{
	62	unsigned long flags;
	63
	64	dev_dbg(micro->dev, "TX msg: %02x, %d bytes\n", msg->id, msg->tx_len);
	65
	66	spin_lock_irqsave(&micro->lock, flags);
	67	if (micro->msg) {
	68	list_add_tail(&msg->node, &micro->queue);
	69	spin_unlock_irqrestore(&micro->lock, flags);
	70	return 0;
	71	}
	72	micro->msg = msg;
	73	ipaq_micro_trigger_tx(micro);
	74	spin_unlock_irqrestore(&micro->lock, flags);
	75	return 0;
	76	}
	77	EXPORT_SYMBOL(ipaq_micro_tx_msg);
	78
	79	static void micro_rx_msg(struct ipaq_micro micro, u8 id, int len, u8 data)
	80	{
	81	int i;
	82
	83	dev_dbg(micro->dev, "RX msg: %02x, %d bytes\n", id, len);
	84
	85	spin_lock(&micro->lock);
	86	switch (id) {
	87	case MSG_VERSION:
	88	case MSG_EEPROM_READ:
	89	case MSG_EEPROM_WRITE:
	90	case MSG_BACKLIGHT:
	91	case MSG_NOTIFY_LED:
	92	case MSG_THERMAL_SENSOR:
	93	case MSG_BATTERY:
	94	/* Handle synchronous messages */
	95	if (micro->msg && micro->msg->id == id) {
	96	struct ipaq_micro_msg *msg = micro->msg;
	97
	98	memcpy(msg->rx_data, data, len);
	99	msg->rx_len = len;
	100	complete(&micro->msg->ack);
	101	if (!list_empty(&micro->queue)) {
	102	micro->msg = list_entry(micro->queue.next,
	103	struct ipaq_micro_msg,
	104	node);
	105	list_del_init(&micro->msg->node);
	106	ipaq_micro_trigger_tx(micro);
	107	} else
	108	micro->msg = NULL;
	109	dev_dbg(micro->dev, "OK RX message 0x%02x\n", id);
	110	} else {
	111	dev_err(micro->dev,
	112	"out of band RX message 0x%02x\n", id);
9336fe91	113	if (!micro->msg)
dcc21cc0 LW	114	dev_info(micro->dev, "no message queued\n");
	115	else
	116	dev_info(micro->dev, "expected message %02x\n",
	117	micro->msg->id);
	118	}
	119	break;
	120	case MSG_KEYBOARD:
	121	if (micro->key)
	122	micro->key(micro->key_data, len, data);
	123	else
9336fe91	124	dev_dbg(micro->dev, "key message ignored, no handle\n");
dcc21cc0 LW	125	break;
	126	case MSG_TOUCHSCREEN:
	127	if (micro->ts)
	128	micro->ts(micro->ts_data, len, data);
	129	else
9336fe91	130	dev_dbg(micro->dev, "touchscreen message ignored, no handle\n");
dcc21cc0 LW	131	break;
	132	default:
	133	dev_err(micro->dev,
	134	"unknown msg %d [%d] ", id, len);
	135	for (i = 0; i < len; ++i)
	136	pr_cont("0x%02x ", data[i]);
	137	pr_cont("\n");
	138	}
	139	spin_unlock(&micro->lock);
	140	}
	141
	142	static void micro_process_char(struct ipaq_micro *micro, u8 ch)
	143	{
	144	struct ipaq_micro_rxdev *rx = &micro->rx;
	145
	146	switch (rx->state) {
	147	case STATE_SOF: /* Looking for SOF */
	148	if (ch == CHAR_SOF)
	149	rx->state = STATE_ID; /* Next byte is the id and len */
	150	break;
	151	case STATE_ID: /* Looking for id and len byte */
9336fe91	152	rx->id = (ch & 0xf0) >> 4;
dcc21cc0 LW	153	rx->len = (ch & 0x0f);
	154	rx->index = 0;
	155	rx->chksum = ch;
	156	rx->state = (rx->len > 0) ? STATE_DATA : STATE_CHKSUM;
	157	break;
	158	case STATE_DATA: /* Looking for 'len' data bytes */
	159	rx->chksum += ch;
	160	rx->buf[rx->index] = ch;
	161	if (++rx->index == rx->len)
	162	rx->state = STATE_CHKSUM;
	163	break;
	164	case STATE_CHKSUM: /* Looking for the checksum */
	165	if (ch == rx->chksum)
	166	micro_rx_msg(micro, rx->id, rx->len, rx->buf);
	167	rx->state = STATE_SOF;
	168	break;
	169	}
	170	}
	171
	172	static void micro_rx_chars(struct ipaq_micro *micro)
	173	{
	174	u32 status, ch;
	175
	176	while ((status = readl(micro->base + UTSR1)) & UTSR1_RNE) {
	177	ch = readl(micro->base + UTDR);
	178	if (status & UTSR1_PRE)
	179	dev_err(micro->dev, "rx: parity error\n");
	180	else if (status & UTSR1_FRE)
	181	dev_err(micro->dev, "rx: framing error\n");
	182	else if (status & UTSR1_ROR)
	183	dev_err(micro->dev, "rx: overrun error\n");
	184	micro_process_char(micro, ch);
	185	}
	186	}
	187
	188	static void ipaq_micro_get_version(struct ipaq_micro *micro)
	189	{
	190	struct ipaq_micro_msg msg = {
	191	.id = MSG_VERSION,
	192	};
	193
	194	ipaq_micro_tx_msg_sync(micro, &msg);
	195	if (msg.rx_len == 4) {
	196	memcpy(micro->version, msg.rx_data, 4);
	197	micro->version[4] = '\0';
	198	} else if (msg.rx_len == 9) {
	199	memcpy(micro->version, msg.rx_data, 4);
	200	micro->version[4] = '\0';
	201	/* Bytes 4-7 are "pack", byte 8 is "boot type" */
	202	} else {
	203	dev_err(micro->dev,
	204	"illegal version message %d bytes\n", msg.rx_len);
	205	}
	206	}
	207
	208	static void ipaq_micro_eeprom_read(struct ipaq_micro *micro,
	209	u8 address, u8 len, u8 *data)
	210	{
	211	struct ipaq_micro_msg msg = {
	212	.id = MSG_EEPROM_READ,
	213	};
	214	u8 i;
	215
	216	for (i = 0; i < len; i++) {
217	msg.tx_data[0] = address + i;
218	msg.tx_data[1] = 1;
219	msg.tx_len = 2;
220	ipaq_micro_tx_msg_sync(micro, &msg);
221	memcpy(data + (i * 2), msg.rx_data, 2);
222	}
223	}
224
225	static char ipaq_micro_str(u8 wchar, u8 len)
226	{
227	char retstr[256];
228	u8 i;
229
230	for (i = 0; i < len / 2; i++)
231	retstr[i] = wchar[i * 2];
232	return kstrdup(retstr, GFP_KERNEL);
233	}
234
235	static u16 ipaq_micro_to_u16(u8 *data)
236	{
237	return data[1] << 8 \| data[0];
238	}
239
035faf4b	240	static void __init ipaq_micro_eeprom_dump(struct ipaq_micro *micro)
dcc21cc0 LW	241	{
	242	u8 dump[256];
	243	char *str;
	244
	245	ipaq_micro_eeprom_read(micro, 0, 128, dump);
	246	str = ipaq_micro_str(dump, 10);
	247	if (str) {
7d60bfc9	248	dev_info(micro->dev, "HW version %s\n", str);
dcc21cc0 LW	249	kfree(str);
	250	}
	251	str = ipaq_micro_str(dump+10, 40);
	252	if (str) {
	253	dev_info(micro->dev, "serial number: %s\n", str);
	254	/* Feed the random pool with this */
	255	add_device_randomness(str, strlen(str));
	256	kfree(str);
	257	}
	258	str = ipaq_micro_str(dump+50, 20);
	259	if (str) {
	260	dev_info(micro->dev, "module ID: %s\n", str);
	261	kfree(str);
	262	}
	263	str = ipaq_micro_str(dump+70, 10);
	264	if (str) {
	265	dev_info(micro->dev, "product revision: %s\n", str);
	266	kfree(str);
	267	}
	268	dev_info(micro->dev, "product ID: %u\n", ipaq_micro_to_u16(dump+80));
	269	dev_info(micro->dev, "frame rate: %u fps\n",
	270	ipaq_micro_to_u16(dump+82));
	271	dev_info(micro->dev, "page mode: %u\n", ipaq_micro_to_u16(dump+84));
	272	dev_info(micro->dev, "country ID: %u\n", ipaq_micro_to_u16(dump+86));
	273	dev_info(micro->dev, "color display: %s\n",
	274	ipaq_micro_to_u16(dump+88) ? "yes" : "no");
	275	dev_info(micro->dev, "ROM size: %u MiB\n", ipaq_micro_to_u16(dump+90));
	276	dev_info(micro->dev, "RAM size: %u KiB\n", ipaq_micro_to_u16(dump+92));
	277	dev_info(micro->dev, "screen: %u x %u\n",
	278	ipaq_micro_to_u16(dump+94), ipaq_micro_to_u16(dump+96));
dcc21cc0 LW	279	}
	280
	281	static void micro_tx_chars(struct ipaq_micro *micro)
	282	{
	283	struct ipaq_micro_txdev *tx = &micro->tx;
	284	u32 val;
	285
	286	while ((tx->index < tx->len) &&
	287	(readl(micro->base + UTSR1) & UTSR1_TNF)) {
	288	writel(tx->buf[tx->index], micro->base + UTDR);
	289	tx->index++;
	290	}
	291
	292	/* Stop interrupts */
	293	val = readl(micro->base + UTCR3);
	294	val &= ~UTCR3_TIE;
	295	writel(val, micro->base + UTCR3);
	296	}
	297
	298	static void micro_reset_comm(struct ipaq_micro *micro)
	299	{
	300	struct ipaq_micro_rxdev *rx = &micro->rx;
	301	u32 val;
	302
	303	if (micro->msg)
	304	complete(&micro->msg->ack);
	305
	306	/* Initialize Serial channel protocol frame */
	307	rx->state = STATE_SOF; /* Reset the state machine */
	308
	309	/* Set up interrupts */
	310	writel(0x01, micro->sdlc + 0x0); /* Select UART mode */
	311
	312	/* Clean up CR3 */
	313	writel(0x0, micro->base + UTCR3);
	314
	315	/* Format: 8N1 */
	316	writel(UTCR0_8BitData \| UTCR0_1StpBit, micro->base + UTCR0);
	317
	318	/* Baud rate: 115200 */
	319	writel(0x0, micro->base + UTCR1);
	320	writel(0x1, micro->base + UTCR2);
	321
	322	/* Clear SR0 */
	323	writel(0xff, micro->base + UTSR0);
	324
	325	/* Enable RX int, disable TX int */
	326	writel(UTCR3_TXE \| UTCR3_RXE \| UTCR3_RIE, micro->base + UTCR3);
	327	val = readl(micro->base + UTCR3);
	328	val &= ~UTCR3_TIE;
	329	writel(val, micro->base + UTCR3);
	330	}
	331
	332	static irqreturn_t micro_serial_isr(int irq, void *dev_id)
	333	{
	334	struct ipaq_micro *micro = dev_id;
	335	struct ipaq_micro_txdev *tx = &micro->tx;
	336	u32 status;
	337
	338	status = readl(micro->base + UTSR0);
	339	do {
	340	if (status & (UTSR0_RID \| UTSR0_RFS)) {
	341	if (status & UTSR0_RID)
	342	/* Clear the Receiver IDLE bit */
343	writel(UTSR0_RID, micro->base + UTSR0);
344	micro_rx_chars(micro);
345	}
346
347	/* Clear break bits */
348	if (status & (UTSR0_RBB \| UTSR0_REB))
349	writel(status & (UTSR0_RBB \| UTSR0_REB),
350	micro->base + UTSR0);
351
352	if (status & UTSR0_TFS)
353	micro_tx_chars(micro);
354
355	status = readl(micro->base + UTSR0);
356
357	} while (((tx->index < tx->len) && (status & UTSR0_TFS)) \|\|
358	(status & (UTSR0_RFS \| UTSR0_RID)));
359
360	return IRQ_HANDLED;
361	}
362
165b1cb1	363	static const struct mfd_cell micro_cells[] = {
dcc21cc0 LW	364	{ .name = "ipaq-micro-backlight", },
	365	{ .name = "ipaq-micro-battery", },
	366	{ .name = "ipaq-micro-keys", },
	367	{ .name = "ipaq-micro-ts", },
	368	{ .name = "ipaq-micro-leds", },
	369	};
	370
dcdf1173	371	static int __maybe_unused micro_resume(struct device *dev)
dcc21cc0 LW	372	{
	373	struct ipaq_micro *micro = dev_get_drvdata(dev);
	374
	375	micro_reset_comm(micro);
	376	mdelay(10);
	377
	378	return 0;
	379	}
	380
035faf4b	381	static int __init micro_probe(struct platform_device *pdev)
dcc21cc0 LW	382	{
	383	struct ipaq_micro *micro;
	384	struct resource *res;
	385	int ret;
	386	int irq;
	387
	388	micro = devm_kzalloc(&pdev->dev, sizeof(*micro), GFP_KERNEL);
	389	if (!micro)
	390	return -ENOMEM;
	391
	392	micro->dev = &pdev->dev;
	393
	394	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
63c348cb JH	395	micro->base = devm_ioremap_resource(&pdev->dev, res);
	396	if (IS_ERR(micro->base))
	397	return PTR_ERR(micro->base);
dcc21cc0 LW	398
	399	res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
	400	if (!res)
	401	return -EINVAL;
	402
63c348cb JH	403	micro->sdlc = devm_ioremap_resource(&pdev->dev, res);
	404	if (IS_ERR(micro->sdlc))
	405	return PTR_ERR(micro->sdlc);
dcc21cc0 LW	406
	407	micro_reset_comm(micro);
	408
	409	irq = platform_get_irq(pdev, 0);
	410	if (!irq)
	411	return -EINVAL;
	412	ret = devm_request_irq(&pdev->dev, irq, micro_serial_isr,
	413	IRQF_SHARED, "ipaq-micro",
	414	micro);
	415	if (ret) {
	416	dev_err(&pdev->dev, "unable to grab serial port IRQ\n");
	417	return ret;
	418	} else
	419	dev_info(&pdev->dev, "grabbed serial port IRQ\n");
	420
	421	spin_lock_init(&micro->lock);
	422	INIT_LIST_HEAD(&micro->queue);
	423	platform_set_drvdata(pdev, micro);
	424
	425	ret = mfd_add_devices(&pdev->dev, pdev->id, micro_cells,
	426	ARRAY_SIZE(micro_cells), NULL, 0, NULL);
	427	if (ret) {
	428	dev_err(&pdev->dev, "error adding MFD cells");
	429	return ret;
	430	}
	431
	432	/* Check version */
	433	ipaq_micro_get_version(micro);
	434	dev_info(&pdev->dev, "Atmel micro ASIC version %s\n", micro->version);
	435	ipaq_micro_eeprom_dump(micro);
	436
	437	return 0;
	438	}
	439
dcc21cc0 LW	440	static const struct dev_pm_ops micro_dev_pm_ops = {
	441	SET_SYSTEM_SLEEP_PM_OPS(NULL, micro_resume)
	442	};
	443
	444	static struct platform_driver micro_device_driver = {
	445	.driver = {
	446	.name = "ipaq-h3xxx-micro",
	447	.pm = &micro_dev_pm_ops,
035faf4b	448	.suppress_bind_attrs = true,
dcc21cc0	449	},
dcc21cc0	450	};
035faf4b	451	builtin_platform_driver_probe(micro_device_driver, micro_probe);