[mirror_ubuntu-zesty-kernel.git] / drivers / media / dvb / mantis / mantis_uart.c

/*
	Mantis PCI bridge driver

	Copyright (C) Manu Abraham (abraham.manu@gmail.com)

	This program is free software; you can redistribute it and/or modify
	it under the terms of the GNU General Public License as published by
	the Free Software Foundation; either version 2 of the License, or
	(at your option) any later version.

	This program is distributed in the hope that it will be useful,
	but WITHOUT ANY WARRANTY; without even the implied warranty of
	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
	GNU General Public License for more details.

	You should have received a copy of the GNU General Public License
	along with this program; if not, write to the Free Software
	Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/

#include <linux/kernel.h>
#include <linux/spinlock.h>

#include <linux/signal.h>
#include <linux/sched.h>
#include <linux/interrupt.h>

#include "dmxdev.h"
#include "dvbdev.h"
#include "dvb_demux.h"
#include "dvb_frontend.h"
#include "dvb_net.h"

#include "mantis_common.h"
#include "mantis_reg.h"
#include "mantis_uart.h"

struct mantis_uart_params {
	enum mantis_baud	baud_rate;
	enum mantis_parity	parity;
};

static struct {
	char string[7];
} rates[5] = {
	{ "9600" },
	{ "19200" },
	{ "38400" },
	{ "57600" },
	{ "115200" }
};

static struct {
	char string[5];
} parity[3] = {
	{ "NONE" },
	{ "ODD" },
	{ "EVEN" }
};

#define UART_MAX_BUF			16

int mantis_uart_read(struct mantis_pci *mantis, u8 *data)
{
	struct mantis_hwconfig *config = mantis->hwconfig;
	u32 stat = 0, i;

	/* get data */
	for (i = 0; i < (config->bytes + 1); i++) {

		stat = mmread(MANTIS_UART_STAT);

		if (stat & MANTIS_UART_RXFIFO_FULL) {
			dprintk(MANTIS_ERROR, 1, "RX Fifo FULL");
		}
		data[i] = mmread(MANTIS_UART_RXD) & 0x3f;

		dprintk(MANTIS_DEBUG, 1, "Reading ... <%02x>", data[i] & 0x3f);

		if (data[i] & (1 << 7)) {
			dprintk(MANTIS_ERROR, 1, "UART framing error");
			return -EINVAL;
		}
		if (data[i] & (1 << 6)) {
			dprintk(MANTIS_ERROR, 1, "UART parity error");
			return -EINVAL;
		}
	}

	return 0;
}

static void mantis_uart_work(struct work_struct *work)
{
	struct mantis_pci *mantis = container_of(work, struct mantis_pci, uart_work);
	struct mantis_hwconfig *config = mantis->hwconfig;
	u8 buf[16];
	int i;

	mantis_uart_read(mantis, buf);

	for (i = 0; i < (config->bytes + 1); i++)
		dprintk(MANTIS_INFO, 1, "UART BUF:%d <%02x> ", i, buf[i]);

	dprintk(MANTIS_DEBUG, 0, "\n");
}

static int mantis_uart_setup(struct mantis_pci *mantis,
			     struct mantis_uart_params *params)
{
	u32 reg;

	mmwrite((mmread(MANTIS_UART_CTL) | (params->parity & 0x3)), MANTIS_UART_CTL);

	reg = mmread(MANTIS_UART_BAUD);

	switch (params->baud_rate) {
	case MANTIS_BAUD_9600:
		reg |= 0xd8;
		break;
	case MANTIS_BAUD_19200:
		reg |= 0x6c;
		break;
	case MANTIS_BAUD_38400:
		reg |= 0x36;
		break;
	case MANTIS_BAUD_57600:
		reg |= 0x23;
		break;
	case MANTIS_BAUD_115200:
		reg |= 0x11;
		break;
	default:
		return -EINVAL;
	}

	mmwrite(reg, MANTIS_UART_BAUD);

	return 0;
}

int mantis_uart_init(struct mantis_pci *mantis)
{
	struct mantis_hwconfig *config = mantis->hwconfig;
	struct mantis_uart_params params;

	/* default parity: */
	params.baud_rate = config->baud_rate;
	params.parity = config->parity;
	dprintk(MANTIS_INFO, 1, "Initializing UART @ %sbps parity:%s",
		rates[params.baud_rate].string,
		parity[params.parity].string);

	init_waitqueue_head(&mantis->uart_wq);
	spin_lock_init(&mantis->uart_lock);

	INIT_WORK(&mantis->uart_work, mantis_uart_work);

	/* disable interrupt */
	mmwrite(mmread(MANTIS_UART_CTL) & 0xffef, MANTIS_UART_CTL);

	mantis_uart_setup(mantis, &params);

	/* default 1 byte */
	mmwrite((mmread(MANTIS_UART_BAUD) | (config->bytes << 8)), MANTIS_UART_BAUD);

	/* flush buffer */
	mmwrite((mmread(MANTIS_UART_CTL) | MANTIS_UART_RXFLUSH), MANTIS_UART_CTL);

	/* enable interrupt */
	mmwrite(mmread(MANTIS_INT_MASK) | 0x800, MANTIS_INT_MASK);
	mmwrite(mmread(MANTIS_UART_CTL) | MANTIS_UART_RXINT, MANTIS_UART_CTL);

	schedule_work(&mantis->uart_work);
	dprintk(MANTIS_DEBUG, 1, "UART successfully initialized");

	return 0;
}
EXPORT_SYMBOL_GPL(mantis_uart_init);

void mantis_uart_exit(struct mantis_pci *mantis)
{
	/* disable interrupt */
	mmwrite(mmread(MANTIS_UART_CTL) & 0xffef, MANTIS_UART_CTL);
	flush_work_sync(&mantis->uart_work);
}
EXPORT_SYMBOL_GPL(mantis_uart_exit);
Commit	Line	Data
a1497357 MA	1	/*
	2	Mantis PCI bridge driver
	3
	4	Copyright (C) Manu Abraham (abraham.manu@gmail.com)
	5
	6	This program is free software; you can redistribute it and/or modify
	7	it under the terms of the GNU General Public License as published by
	8	the Free Software Foundation; either version 2 of the License, or
	9	(at your option) any later version.
	10
	11	This program is distributed in the hope that it will be useful,
	12	but WITHOUT ANY WARRANTY; without even the implied warranty of
	13	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	14	GNU General Public License for more details.
	15
	16	You should have received a copy of the GNU General Public License
	17	along with this program; if not, write to the Free Software
	18	Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
	19	*/
	20
b3b96144	21	#include <linux/kernel.h>
add20636	22	#include <linux/spinlock.h>
b3b96144	23
b3b96144 MA	24	#include <linux/signal.h>
	25	#include <linux/sched.h>
	26	#include <linux/interrupt.h>
	27
	28	#include "dmxdev.h"
	29	#include "dvbdev.h"
	30	#include "dvb_demux.h"
	31	#include "dvb_frontend.h"
	32	#include "dvb_net.h"
	33
add20636	34	#include "mantis_common.h"
b3b96144 MA	35	#include "mantis_reg.h"
b3b96144 MA	36	#include "mantis_uart.h"
add20636 MA	37
	38	struct mantis_uart_params {
	39	enum mantis_baud baud_rate;
	40	enum mantis_parity parity;
	41	};
	42
a1497357 MA	43	static struct {
	44	char string[7];
	45	} rates[5] = {
	46	{ "9600" },
	47	{ "19200" },
	48	{ "38400" },
	49	{ "57600" },
	50	{ "115200" }
	51	};
	52
	53	static struct {
	54	char string[5];
	55	} parity[3] = {
	56	{ "NONE" },
	57	{ "ODD" },
	58	{ "EVEN" }
	59	};
	60
add20636 MA	61	#define UART_MAX_BUF 16
	62
	63	int mantis_uart_read(struct mantis_pci mantis, u8 data)
	64	{
	65	struct mantis_hwconfig *config = mantis->hwconfig;
0bdc799b	66	u32 stat = 0, i;
add20636 MA	67
	68	/* get data */
	69	for (i = 0; i < (config->bytes + 1); i++) {
	70
0bdc799b MA	71	stat = mmread(MANTIS_UART_STAT);
0bdc799b MA	72
add20636	73	if (stat & MANTIS_UART_RXFIFO_FULL) {
b3b96144	74	dprintk(MANTIS_ERROR, 1, "RX Fifo FULL");
add20636 MA	75	}
	76	data[i] = mmread(MANTIS_UART_RXD) & 0x3f;
	77
b3b96144	78	dprintk(MANTIS_DEBUG, 1, "Reading ... <%02x>", data[i] & 0x3f);
add20636 MA	79
add20636 MA	80	if (data[i] & (1 << 7)) {
b3b96144	81	dprintk(MANTIS_ERROR, 1, "UART framing error");
add20636 MA	82	return -EINVAL;
	83	}
	84	if (data[i] & (1 << 6)) {
b3b96144	85	dprintk(MANTIS_ERROR, 1, "UART parity error");
add20636 MA	86	return -EINVAL;
	87	}
	88	}
	89
	90	return 0;
	91	}
	92
	93	static void mantis_uart_work(struct work_struct *work)
	94	{
	95	struct mantis_pci *mantis = container_of(work, struct mantis_pci, uart_work);
	96	struct mantis_hwconfig *config = mantis->hwconfig;
	97	u8 buf[16];
	98	int i;
	99
add20636 MA	100	mantis_uart_read(mantis, buf);
add20636 MA	101
add20636	102	for (i = 0; i < (config->bytes + 1); i++)
a1497357	103	dprintk(MANTIS_INFO, 1, "UART BUF:%d <%02x> ", i, buf[i]);
add20636	104
b3b96144	105	dprintk(MANTIS_DEBUG, 0, "\n");
add20636 MA	106	}
	107
	108	static int mantis_uart_setup(struct mantis_pci *mantis,
	109	struct mantis_uart_params *params)
	110	{
add20636 MA	111	u32 reg;
add20636 MA	112
add20636 MA	113	mmwrite((mmread(MANTIS_UART_CTL) \| (params->parity & 0x3)), MANTIS_UART_CTL);
	114
	115	reg = mmread(MANTIS_UART_BAUD);
	116
	117	switch (params->baud_rate) {
	118	case MANTIS_BAUD_9600:
	119	reg \|= 0xd8;
	120	break;
	121	case MANTIS_BAUD_19200:
	122	reg \|= 0x6c;
	123	break;
	124	case MANTIS_BAUD_38400:
	125	reg \|= 0x36;
	126	break;
	127	case MANTIS_BAUD_57600:
	128	reg \|= 0x23;
	129	break;
	130	case MANTIS_BAUD_115200:
	131	reg \|= 0x11;
	132	break;
	133	default:
	134	return -EINVAL;
	135	}
	136
	137	mmwrite(reg, MANTIS_UART_BAUD);
	138
	139	return 0;
	140	}
	141
	142	int mantis_uart_init(struct mantis_pci *mantis)
	143	{
	144	struct mantis_hwconfig *config = mantis->hwconfig;
	145	struct mantis_uart_params params;
	146
add20636 MA	147	/* default parity: */
	148	params.baud_rate = config->baud_rate;
	149	params.parity = config->parity;
a1497357 MA	150	dprintk(MANTIS_INFO, 1, "Initializing UART @ %sbps parity:%s",
	151	rates[params.baud_rate].string,
	152	parity[params.parity].string);
add20636 MA	153
	154	init_waitqueue_head(&mantis->uart_wq);
	155	spin_lock_init(&mantis->uart_lock);
	156
	157	INIT_WORK(&mantis->uart_work, mantis_uart_work);
	158
	159	/* disable interrupt */
	160	mmwrite(mmread(MANTIS_UART_CTL) & 0xffef, MANTIS_UART_CTL);
	161
	162	mantis_uart_setup(mantis, &params);
	163
	164	/* default 1 byte */
	165	mmwrite((mmread(MANTIS_UART_BAUD) \| (config->bytes << 8)), MANTIS_UART_BAUD);
	166
	167	/* flush buffer */
	168	mmwrite((mmread(MANTIS_UART_CTL) \| MANTIS_UART_RXFLUSH), MANTIS_UART_CTL);
	169
	170	/* enable interrupt */
	171	mmwrite(mmread(MANTIS_INT_MASK) \| 0x800, MANTIS_INT_MASK);
	172	mmwrite(mmread(MANTIS_UART_CTL) \| MANTIS_UART_RXINT, MANTIS_UART_CTL);
	173
	174	schedule_work(&mantis->uart_work);
25985edc	175	dprintk(MANTIS_DEBUG, 1, "UART successfully initialized");
add20636 MA	176
	177	return 0;
	178	}
b3b96144	179	EXPORT_SYMBOL_GPL(mantis_uart_init);
add20636 MA	180
	181	void mantis_uart_exit(struct mantis_pci *mantis)
	182	{
	183	/* disable interrupt */
	184	mmwrite(mmread(MANTIS_UART_CTL) & 0xffef, MANTIS_UART_CTL);
0d9c76ae	185	flush_work_sync(&mantis->uart_work);
add20636	186	}
b3b96144	187	EXPORT_SYMBOL_GPL(mantis_uart_exit);