[mirror_ubuntu-focal-kernel.git] / drivers / media / pci / b2c2 / flexcop-dma.c

// SPDX-License-Identifier: GPL-2.0
/*
 * Linux driver for digital TV devices equipped with B2C2 FlexcopII(b)/III
 * flexcop-dma.c - configuring and controlling the DMA of the FlexCop
 * see flexcop.c for copyright information
 */
#include "flexcop.h"

int flexcop_dma_allocate(struct pci_dev *pdev,
		struct flexcop_dma *dma, u32 size)
{
	u8 *tcpu;
	dma_addr_t tdma = 0;

	if (size % 2) {
		err("dma buffersize has to be even.");
		return -EINVAL;
	}

	if ((tcpu = pci_alloc_consistent(pdev, size, &tdma)) != NULL) {
		dma->pdev = pdev;
		dma->cpu_addr0 = tcpu;
		dma->dma_addr0 = tdma;
		dma->cpu_addr1 = tcpu + size/2;
		dma->dma_addr1 = tdma + size/2;
		dma->size = size/2;
		return 0;
	}
	return -ENOMEM;
}
EXPORT_SYMBOL(flexcop_dma_allocate);

void flexcop_dma_free(struct flexcop_dma *dma)
{
	pci_free_consistent(dma->pdev, dma->size*2,
			dma->cpu_addr0, dma->dma_addr0);
	memset(dma,0,sizeof(struct flexcop_dma));
}
EXPORT_SYMBOL(flexcop_dma_free);

int flexcop_dma_config(struct flexcop_device *fc,
		struct flexcop_dma *dma,
		flexcop_dma_index_t dma_idx)
{
	flexcop_ibi_value v0x0,v0x4,v0xc;
	v0x0.raw = v0x4.raw = v0xc.raw = 0;

	v0x0.dma_0x0.dma_address0 = dma->dma_addr0 >> 2;
	v0xc.dma_0xc.dma_address1 = dma->dma_addr1 >> 2;
	v0x4.dma_0x4_write.dma_addr_size = dma->size / 4;

	if ((dma_idx & FC_DMA_1) == dma_idx) {
		fc->write_ibi_reg(fc,dma1_000,v0x0);
		fc->write_ibi_reg(fc,dma1_004,v0x4);
		fc->write_ibi_reg(fc,dma1_00c,v0xc);
	} else if ((dma_idx & FC_DMA_2) == dma_idx) {
		fc->write_ibi_reg(fc,dma2_010,v0x0);
		fc->write_ibi_reg(fc,dma2_014,v0x4);
		fc->write_ibi_reg(fc,dma2_01c,v0xc);
	} else {
		err("either DMA1 or DMA2 can be configured within one flexcop_dma_config call.");
		return -EINVAL;
	}

	return 0;
}
EXPORT_SYMBOL(flexcop_dma_config);

/* start the DMA transfers, but not the DMA IRQs */
int flexcop_dma_xfer_control(struct flexcop_device *fc,
		flexcop_dma_index_t dma_idx,
		flexcop_dma_addr_index_t index,
		int onoff)
{
	flexcop_ibi_value v0x0,v0xc;
	flexcop_ibi_register r0x0,r0xc;

	if ((dma_idx & FC_DMA_1) == dma_idx) {
		r0x0 = dma1_000;
		r0xc = dma1_00c;
	} else if ((dma_idx & FC_DMA_2) == dma_idx) {
		r0x0 = dma2_010;
		r0xc = dma2_01c;
	} else {
		err("either transfer DMA1 or DMA2 can be started within one flexcop_dma_xfer_control call.");
		return -EINVAL;
	}

	v0x0 = fc->read_ibi_reg(fc,r0x0);
	v0xc = fc->read_ibi_reg(fc,r0xc);

	deb_rdump("reg: %03x: %x\n",r0x0,v0x0.raw);
	deb_rdump("reg: %03x: %x\n",r0xc,v0xc.raw);

	if (index & FC_DMA_SUBADDR_0)
		v0x0.dma_0x0.dma_0start = onoff;

	if (index & FC_DMA_SUBADDR_1)
		v0xc.dma_0xc.dma_1start = onoff;

	fc->write_ibi_reg(fc,r0x0,v0x0);
	fc->write_ibi_reg(fc,r0xc,v0xc);

	deb_rdump("reg: %03x: %x\n",r0x0,v0x0.raw);
	deb_rdump("reg: %03x: %x\n",r0xc,v0xc.raw);
	return 0;
}
EXPORT_SYMBOL(flexcop_dma_xfer_control);

static int flexcop_dma_remap(struct flexcop_device *fc,
		flexcop_dma_index_t dma_idx,
		int onoff)
{
	flexcop_ibi_register r = (dma_idx & FC_DMA_1) ? dma1_00c : dma2_01c;
	flexcop_ibi_value v = fc->read_ibi_reg(fc,r);
	deb_info("%s\n",__func__);
	v.dma_0xc.remap_enable = onoff;
	fc->write_ibi_reg(fc,r,v);
	return 0;
}

int flexcop_dma_control_size_irq(struct flexcop_device *fc,
		flexcop_dma_index_t no,
		int onoff)
{
	flexcop_ibi_value v = fc->read_ibi_reg(fc,ctrl_208);

	if (no & FC_DMA_1)
		v.ctrl_208.DMA1_IRQ_Enable_sig = onoff;

	if (no & FC_DMA_2)
		v.ctrl_208.DMA2_IRQ_Enable_sig = onoff;

	fc->write_ibi_reg(fc,ctrl_208,v);
	return 0;
}
EXPORT_SYMBOL(flexcop_dma_control_size_irq);

int flexcop_dma_control_timer_irq(struct flexcop_device *fc,
		flexcop_dma_index_t no,
		int onoff)
{
	flexcop_ibi_value v = fc->read_ibi_reg(fc,ctrl_208);

	if (no & FC_DMA_1)
		v.ctrl_208.DMA1_Timer_Enable_sig = onoff;

	if (no & FC_DMA_2)
		v.ctrl_208.DMA2_Timer_Enable_sig = onoff;

	fc->write_ibi_reg(fc,ctrl_208,v);
	return 0;
}
EXPORT_SYMBOL(flexcop_dma_control_timer_irq);

/* 1 cycles = 1.97 msec */
int flexcop_dma_config_timer(struct flexcop_device *fc,
		flexcop_dma_index_t dma_idx, u8 cycles)
{
	flexcop_ibi_register r = (dma_idx & FC_DMA_1) ? dma1_004 : dma2_014;
	flexcop_ibi_value v = fc->read_ibi_reg(fc,r);

	flexcop_dma_remap(fc,dma_idx,0);

	deb_info("%s\n",__func__);
	v.dma_0x4_write.dmatimer = cycles;
	fc->write_ibi_reg(fc,r,v);
	return 0;
}
EXPORT_SYMBOL(flexcop_dma_config_timer);
Commit	Line	Data
b2441318	1	// SPDX-License-Identifier: GPL-2.0
2add87a9	2	/*
1589a993 UB	3	* Linux driver for digital TV devices equipped with B2C2 FlexcopII(b)/III
	4	* flexcop-dma.c - configuring and controlling the DMA of the FlexCop
	5	* see flexcop.c for copyright information
2add87a9 JS	6	*/
	7	#include "flexcop.h"
	8
1589a993 UB	9	int flexcop_dma_allocate(struct pci_dev *pdev,
1589a993 UB	10	struct flexcop_dma *dma, u32 size)
2add87a9 JS	11	{
2add87a9 JS	12	u8 *tcpu;
614b147b	13	dma_addr_t tdma = 0;
2add87a9 JS	14
	15	if (size % 2) {
	16	err("dma buffersize has to be even.");
	17	return -EINVAL;
	18	}
	19
	20	if ((tcpu = pci_alloc_consistent(pdev, size, &tdma)) != NULL) {
	21	dma->pdev = pdev;
	22	dma->cpu_addr0 = tcpu;
	23	dma->dma_addr0 = tdma;
	24	dma->cpu_addr1 = tcpu + size/2;
	25	dma->dma_addr1 = tdma + size/2;
	26	dma->size = size/2;
	27	return 0;
	28	}
	29	return -ENOMEM;
	30	}
	31	EXPORT_SYMBOL(flexcop_dma_allocate);
	32
	33	void flexcop_dma_free(struct flexcop_dma *dma)
	34	{
1589a993 UB	35	pci_free_consistent(dma->pdev, dma->size*2,
1589a993 UB	36	dma->cpu_addr0, dma->dma_addr0);
2add87a9 JS	37	memset(dma,0,sizeof(struct flexcop_dma));
	38	}
	39	EXPORT_SYMBOL(flexcop_dma_free);
	40
64221be7 PB	41	int flexcop_dma_config(struct flexcop_device *fc,
	42	struct flexcop_dma *dma,
	43	flexcop_dma_index_t dma_idx)
2add87a9	44	{
64221be7 PB	45	flexcop_ibi_value v0x0,v0x4,v0xc;
64221be7 PB	46	v0x0.raw = v0x4.raw = v0xc.raw = 0;
2add87a9	47
1589a993 UB	48	v0x0.dma_0x0.dma_address0 = dma->dma_addr0 >> 2;
1589a993 UB	49	v0xc.dma_0xc.dma_address1 = dma->dma_addr1 >> 2;
64221be7	50	v0x4.dma_0x4_write.dma_addr_size = dma->size / 4;
2add87a9	51
64221be7 PB	52	if ((dma_idx & FC_DMA_1) == dma_idx) {
	53	fc->write_ibi_reg(fc,dma1_000,v0x0);
	54	fc->write_ibi_reg(fc,dma1_004,v0x4);
	55	fc->write_ibi_reg(fc,dma1_00c,v0xc);
	56	} else if ((dma_idx & FC_DMA_2) == dma_idx) {
	57	fc->write_ibi_reg(fc,dma2_010,v0x0);
	58	fc->write_ibi_reg(fc,dma2_014,v0x4);
	59	fc->write_ibi_reg(fc,dma2_01c,v0xc);
	60	} else {
d6376f0e	61	err("either DMA1 or DMA2 can be configured within one flexcop_dma_config call.");
64221be7 PB	62	return -EINVAL;
64221be7 PB	63	}
2add87a9	64
2add87a9 JS	65	return 0;
2add87a9 JS	66	}
64221be7 PB	67	EXPORT_SYMBOL(flexcop_dma_config);
	68
	69	/* start the DMA transfers, but not the DMA IRQs */
	70	int flexcop_dma_xfer_control(struct flexcop_device *fc,
	71	flexcop_dma_index_t dma_idx,
	72	flexcop_dma_addr_index_t index,
	73	int onoff)
	74	{
	75	flexcop_ibi_value v0x0,v0xc;
	76	flexcop_ibi_register r0x0,r0xc;
	77
	78	if ((dma_idx & FC_DMA_1) == dma_idx) {
	79	r0x0 = dma1_000;
	80	r0xc = dma1_00c;
	81	} else if ((dma_idx & FC_DMA_2) == dma_idx) {
	82	r0x0 = dma2_010;
	83	r0xc = dma2_01c;
	84	} else {
d6376f0e	85	err("either transfer DMA1 or DMA2 can be started within one flexcop_dma_xfer_control call.");
64221be7 PB	86	return -EINVAL;
	87	}
	88
	89	v0x0 = fc->read_ibi_reg(fc,r0x0);
	90	v0xc = fc->read_ibi_reg(fc,r0xc);
	91
	92	deb_rdump("reg: %03x: %x\n",r0x0,v0x0.raw);
	93	deb_rdump("reg: %03x: %x\n",r0xc,v0xc.raw);
	94
	95	if (index & FC_DMA_SUBADDR_0)
	96	v0x0.dma_0x0.dma_0start = onoff;
	97
	98	if (index & FC_DMA_SUBADDR_1)
	99	v0xc.dma_0xc.dma_1start = onoff;
	100
	101	fc->write_ibi_reg(fc,r0x0,v0x0);
	102	fc->write_ibi_reg(fc,r0xc,v0xc);
	103
	104	deb_rdump("reg: %03x: %x\n",r0x0,v0x0.raw);
	105	deb_rdump("reg: %03x: %x\n",r0xc,v0xc.raw);
	106	return 0;
	107	}
	108	EXPORT_SYMBOL(flexcop_dma_xfer_control);
	109
	110	static int flexcop_dma_remap(struct flexcop_device *fc,
	111	flexcop_dma_index_t dma_idx,
	112	int onoff)
	113	{
	114	flexcop_ibi_register r = (dma_idx & FC_DMA_1) ? dma1_00c : dma2_01c;
	115	flexcop_ibi_value v = fc->read_ibi_reg(fc,r);
7bca4498	116	deb_info("%s\n",__func__);
64221be7 PB	117	v.dma_0xc.remap_enable = onoff;
	118	fc->write_ibi_reg(fc,r,v);
	119	return 0;
	120	}
2add87a9	121
64221be7 PB	122	int flexcop_dma_control_size_irq(struct flexcop_device *fc,
	123	flexcop_dma_index_t no,
	124	int onoff)
2add87a9 JS	125	{
	126	flexcop_ibi_value v = fc->read_ibi_reg(fc,ctrl_208);
	127
	128	if (no & FC_DMA_1)
	129	v.ctrl_208.DMA1_IRQ_Enable_sig = onoff;
	130
	131	if (no & FC_DMA_2)
	132	v.ctrl_208.DMA2_IRQ_Enable_sig = onoff;
	133
	134	fc->write_ibi_reg(fc,ctrl_208,v);
	135	return 0;
	136	}
	137	EXPORT_SYMBOL(flexcop_dma_control_size_irq);
	138
64221be7 PB	139	int flexcop_dma_control_timer_irq(struct flexcop_device *fc,
	140	flexcop_dma_index_t no,
	141	int onoff)
2add87a9 JS	142	{
	143	flexcop_ibi_value v = fc->read_ibi_reg(fc,ctrl_208);
	144
	145	if (no & FC_DMA_1)
64221be7	146	v.ctrl_208.DMA1_Timer_Enable_sig = onoff;
2add87a9 JS	147
2add87a9 JS	148	if (no & FC_DMA_2)
64221be7	149	v.ctrl_208.DMA2_Timer_Enable_sig = onoff;
2add87a9 JS	150
	151	fc->write_ibi_reg(fc,ctrl_208,v);
	152	return 0;
	153	}
64221be7	154	EXPORT_SYMBOL(flexcop_dma_control_timer_irq);
2add87a9	155
64221be7 PB	156	/* 1 cycles = 1.97 msec */
64221be7 PB	157	int flexcop_dma_config_timer(struct flexcop_device *fc,
1589a993	158	flexcop_dma_index_t dma_idx, u8 cycles)
2add87a9	159	{
64221be7 PB	160	flexcop_ibi_register r = (dma_idx & FC_DMA_1) ? dma1_004 : dma2_014;
64221be7 PB	161	flexcop_ibi_value v = fc->read_ibi_reg(fc,r);
2add87a9	162
64221be7	163	flexcop_dma_remap(fc,dma_idx,0);
2add87a9	164
7bca4498	165	deb_info("%s\n",__func__);
64221be7	166	v.dma_0x4_write.dmatimer = cycles;
2add87a9 JS	167	fc->write_ibi_reg(fc,r,v);
	168	return 0;
	169	}
64221be7	170	EXPORT_SYMBOL(flexcop_dma_config_timer);
2add87a9	171