[mirror_ubuntu-jammy-kernel.git] / drivers / media / pci / bt8xx / btcx-risc.c

// SPDX-License-Identifier: GPL-2.0-or-later
/*

    btcx-risc.c

    bt848/bt878/cx2388x risc code generator.

    (c) 2000-03 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]


*/

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <linux/module.h>
#include <linux/init.h>
#include <linux/pci.h>
#include <linux/interrupt.h>
#include <linux/videodev2.h>
#include <asm/page.h>
#include <asm/pgtable.h>

#include "btcx-risc.h"

static unsigned int btcx_debug;
module_param(btcx_debug, int, 0644);
MODULE_PARM_DESC(btcx_debug,"debug messages, default is 0 (no)");

#define dprintk(fmt, arg...) do {				\
	if (btcx_debug)						\
		printk(KERN_DEBUG pr_fmt("%s: " fmt),		\
		       __func__, ##arg);			\
} while (0)


/* ---------------------------------------------------------- */
/* allocate/free risc memory                                  */

static int memcnt;

void btcx_riscmem_free(struct pci_dev *pci,
		       struct btcx_riscmem *risc)
{
	if (NULL == risc->cpu)
		return;

	memcnt--;
	dprintk("btcx: riscmem free [%d] dma=%lx\n",
		memcnt, (unsigned long)risc->dma);

	pci_free_consistent(pci, risc->size, risc->cpu, risc->dma);
	memset(risc,0,sizeof(*risc));
}

int btcx_riscmem_alloc(struct pci_dev *pci,
		       struct btcx_riscmem *risc,
		       unsigned int size)
{
	__le32 *cpu;
	dma_addr_t dma = 0;

	if (NULL != risc->cpu && risc->size < size)
		btcx_riscmem_free(pci,risc);
	if (NULL == risc->cpu) {
		cpu = pci_alloc_consistent(pci, size, &dma);
		if (NULL == cpu)
			return -ENOMEM;
		risc->cpu  = cpu;
		risc->dma  = dma;
		risc->size = size;

		memcnt++;
		dprintk("btcx: riscmem alloc [%d] dma=%lx cpu=%p size=%d\n",
			memcnt, (unsigned long)dma, cpu, size);
	}
	memset(risc->cpu,0,risc->size);
	return 0;
}

/* ---------------------------------------------------------- */
/* screen overlay helpers                                     */

int
btcx_screen_clips(int swidth, int sheight, struct v4l2_rect *win,
		  struct v4l2_clip *clips, unsigned int n)
{
	if (win->left < 0) {
		/* left */
		clips[n].c.left = 0;
		clips[n].c.top = 0;
		clips[n].c.width  = -win->left;
		clips[n].c.height = win->height;
		n++;
	}
	if (win->left + win->width > swidth) {
		/* right */
		clips[n].c.left   = swidth - win->left;
		clips[n].c.top    = 0;
		clips[n].c.width  = win->width - clips[n].c.left;
		clips[n].c.height = win->height;
		n++;
	}
	if (win->top < 0) {
		/* top */
		clips[n].c.left = 0;
		clips[n].c.top = 0;
		clips[n].c.width  = win->width;
		clips[n].c.height = -win->top;
		n++;
	}
	if (win->top + win->height > sheight) {
		/* bottom */
		clips[n].c.left = 0;
		clips[n].c.top = sheight - win->top;
		clips[n].c.width  = win->width;
		clips[n].c.height = win->height - clips[n].c.top;
		n++;
	}
	return n;
}

int
btcx_align(struct v4l2_rect *win, struct v4l2_clip *clips, unsigned int n, int mask)
{
	s32 nx,nw,dx;
	unsigned int i;

	/* fixup window */
	nx = (win->left + mask) & ~mask;
	nw = (win->width) & ~mask;
	if (nx + nw > win->left + win->width)
		nw -= mask+1;
	dx = nx - win->left;
	win->left  = nx;
	win->width = nw;
	dprintk("btcx: window align %dx%d+%d+%d [dx=%d]\n",
	       win->width, win->height, win->left, win->top, dx);

	/* fixup clips */
	for (i = 0; i < n; i++) {
		nx = (clips[i].c.left-dx) & ~mask;
		nw = (clips[i].c.width) & ~mask;
		if (nx + nw < clips[i].c.left-dx + clips[i].c.width)
			nw += mask+1;
		clips[i].c.left  = nx;
		clips[i].c.width = nw;
		dprintk("btcx:   clip align %dx%d+%d+%d\n",
		       clips[i].c.width, clips[i].c.height,
		       clips[i].c.left, clips[i].c.top);
	}
	return 0;
}

void
btcx_sort_clips(struct v4l2_clip *clips, unsigned int nclips)
{
	int i,j,n;

	if (nclips < 2)
		return;
	for (i = nclips-2; i >= 0; i--) {
		for (n = 0, j = 0; j <= i; j++) {
			if (clips[j].c.left > clips[j+1].c.left) {
				swap(clips[j], clips[j + 1]);
				n++;
			}
		}
		if (0 == n)
			break;
	}
}

void
btcx_calc_skips(int line, int width, int *maxy,
		struct btcx_skiplist *skips, unsigned int *nskips,
		const struct v4l2_clip *clips, unsigned int nclips)
{
	unsigned int clip,skip;
	int end, maxline;

	skip=0;
	maxline = 9999;
	for (clip = 0; clip < nclips; clip++) {

		/* sanity checks */
		if (clips[clip].c.left + clips[clip].c.width <= 0)
			continue;
		if (clips[clip].c.left > (signed)width)
			break;

		/* vertical range */
		if (line > clips[clip].c.top+clips[clip].c.height-1)
			continue;
		if (line < clips[clip].c.top) {
			if (maxline > clips[clip].c.top-1)
				maxline = clips[clip].c.top-1;
			continue;
		}
		if (maxline > clips[clip].c.top+clips[clip].c.height-1)
			maxline = clips[clip].c.top+clips[clip].c.height-1;

		/* horizontal range */
		if (0 == skip || clips[clip].c.left > skips[skip-1].end) {
			/* new one */
			skips[skip].start = clips[clip].c.left;
			if (skips[skip].start < 0)
				skips[skip].start = 0;
			skips[skip].end = clips[clip].c.left + clips[clip].c.width;
			if (skips[skip].end > width)
				skips[skip].end = width;
			skip++;
		} else {
			/* overlaps -- expand last one */
			end = clips[clip].c.left + clips[clip].c.width;
			if (skips[skip-1].end < end)
				skips[skip-1].end = end;
			if (skips[skip-1].end > width)
				skips[skip-1].end = width;
		}
	}
	*nskips = skip;
	*maxy = maxline;

	if (btcx_debug) {
		dprintk("btcx: skips line %d-%d:", line, maxline);
		for (skip = 0; skip < *nskips; skip++) {
			pr_cont(" %d-%d", skips[skip].start, skips[skip].end);
		}
		pr_cont("\n");
	}
}
Commit	Line	Data
74ba9207	1	// SPDX-License-Identifier: GPL-2.0-or-later
1da177e4	2	/*
1da177e4 LT	3
	4	btcx-risc.c
	5
	6	bt848/bt878/cx2388x risc code generator.
	7
	8	(c) 2000-03 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]
	9
1da177e4 LT	10
	11	*/
	12
fa132a64 MCC	13	#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
fa132a64 MCC	14
1da177e4	15	#include <linux/module.h>
1da177e4 LT	16	#include <linux/init.h>
	17	#include <linux/pci.h>
	18	#include <linux/interrupt.h>
	19	#include <linux/videodev2.h>
	20	#include <asm/page.h>
	21	#include <asm/pgtable.h>
	22
	23	#include "btcx-risc.h"
	24
90ca8bef HV	25	static unsigned int btcx_debug;
	26	module_param(btcx_debug, int, 0644);
	27	MODULE_PARM_DESC(btcx_debug,"debug messages, default is 0 (no)");
1da177e4	28
fa132a64 MCC	29	#define dprintk(fmt, arg...) do { \
	30	if (btcx_debug) \
	31	printk(KERN_DEBUG pr_fmt("%s: " fmt), \
	32	__func__, ##arg); \
	33	} while (0)
	34
	35
1da177e4 LT	36	/* ---------------------------------------------------------- */
	37	/* allocate/free risc memory */
	38
	39	static int memcnt;
	40
	41	void btcx_riscmem_free(struct pci_dev *pci,
	42	struct btcx_riscmem *risc)
	43	{
	44	if (NULL == risc->cpu)
	45	return;
fa132a64 MCC	46
	47	memcnt--;
	48	dprintk("btcx: riscmem free [%d] dma=%lx\n",
	49	memcnt, (unsigned long)risc->dma);
	50
1da177e4 LT	51	pci_free_consistent(pci, risc->size, risc->cpu, risc->dma);
	52	memset(risc,0,sizeof(*risc));
	53	}
	54
	55	int btcx_riscmem_alloc(struct pci_dev *pci,
	56	struct btcx_riscmem *risc,
	57	unsigned int size)
	58	{
d8eaa58b	59	__le32 *cpu;
614b147b	60	dma_addr_t dma = 0;
1da177e4 LT	61
	62	if (NULL != risc->cpu && risc->size < size)
	63	btcx_riscmem_free(pci,risc);
	64	if (NULL == risc->cpu) {
	65	cpu = pci_alloc_consistent(pci, size, &dma);
	66	if (NULL == cpu)
	67	return -ENOMEM;
	68	risc->cpu = cpu;
	69	risc->dma = dma;
	70	risc->size = size;
fa132a64 MCC	71
	72	memcnt++;
	73	dprintk("btcx: riscmem alloc [%d] dma=%lx cpu=%p size=%d\n",
	74	memcnt, (unsigned long)dma, cpu, size);
1da177e4 LT	75	}
	76	memset(risc->cpu,0,risc->size);
	77	return 0;
	78	}
	79
	80	/* ---------------------------------------------------------- */
	81	/* screen overlay helpers */
	82
	83	int
	84	btcx_screen_clips(int swidth, int sheight, struct v4l2_rect *win,
	85	struct v4l2_clip *clips, unsigned int n)
	86	{
	87	if (win->left < 0) {
	88	/* left */
	89	clips[n].c.left = 0;
	90	clips[n].c.top = 0;
	91	clips[n].c.width = -win->left;
	92	clips[n].c.height = win->height;
	93	n++;
	94	}
	95	if (win->left + win->width > swidth) {
	96	/* right */
	97	clips[n].c.left = swidth - win->left;
	98	clips[n].c.top = 0;
	99	clips[n].c.width = win->width - clips[n].c.left;
	100	clips[n].c.height = win->height;
	101	n++;
	102	}
	103	if (win->top < 0) {
	104	/* top */
	105	clips[n].c.left = 0;
	106	clips[n].c.top = 0;
	107	clips[n].c.width = win->width;
	108	clips[n].c.height = -win->top;
	109	n++;
	110	}
	111	if (win->top + win->height > sheight) {
	112	/* bottom */
	113	clips[n].c.left = 0;
	114	clips[n].c.top = sheight - win->top;
	115	clips[n].c.width = win->width;
	116	clips[n].c.height = win->height - clips[n].c.top;
	117	n++;
	118	}
	119	return n;
	120	}
	121
	122	int
	123	btcx_align(struct v4l2_rect win, struct v4l2_clip clips, unsigned int n, int mask)
	124	{
	125	s32 nx,nw,dx;
	126	unsigned int i;
	127
	128	/* fixup window */
	129	nx = (win->left + mask) & ~mask;
	130	nw = (win->width) & ~mask;
	131	if (nx + nw > win->left + win->width)
	132	nw -= mask+1;
	133	dx = nx - win->left;
	134	win->left = nx;
	135	win->width = nw;
fa132a64 MCC	136	dprintk("btcx: window align %dx%d+%d+%d [dx=%d]\n",
fa132a64 MCC	137	win->width, win->height, win->left, win->top, dx);
1da177e4 LT	138
	139	/* fixup clips */
	140	for (i = 0; i < n; i++) {
	141	nx = (clips[i].c.left-dx) & ~mask;
	142	nw = (clips[i].c.width) & ~mask;
	143	if (nx + nw < clips[i].c.left-dx + clips[i].c.width)
	144	nw += mask+1;
	145	clips[i].c.left = nx;
	146	clips[i].c.width = nw;
fa132a64 MCC	147	dprintk("btcx: clip align %dx%d+%d+%d\n",
	148	clips[i].c.width, clips[i].c.height,
	149	clips[i].c.left, clips[i].c.top);
1da177e4 LT	150	}
	151	return 0;
	152	}
	153
	154	void
	155	btcx_sort_clips(struct v4l2_clip *clips, unsigned int nclips)
	156	{
1da177e4 LT	157	int i,j,n;
	158
	159	if (nclips < 2)
	160	return;
	161	for (i = nclips-2; i >= 0; i--) {
	162	for (n = 0, j = 0; j <= i; j++) {
	163	if (clips[j].c.left > clips[j+1].c.left) {
30533ad1	164	swap(clips[j], clips[j + 1]);
1da177e4 LT	165	n++;
	166	}
	167	}
	168	if (0 == n)
	169	break;
	170	}
	171	}
	172
	173	void
c6eb8eaf	174	btcx_calc_skips(int line, int width, int *maxy,
1da177e4 LT	175	struct btcx_skiplist skips, unsigned int nskips,
	176	const struct v4l2_clip *clips, unsigned int nclips)
	177	{
	178	unsigned int clip,skip;
c6eb8eaf	179	int end, maxline;
1da177e4 LT	180
	181	skip=0;
	182	maxline = 9999;
	183	for (clip = 0; clip < nclips; clip++) {
	184
	185	/* sanity checks */
	186	if (clips[clip].c.left + clips[clip].c.width <= 0)
	187	continue;
	188	if (clips[clip].c.left > (signed)width)
	189	break;
	190
	191	/* vertical range */
	192	if (line > clips[clip].c.top+clips[clip].c.height-1)
	193	continue;
	194	if (line < clips[clip].c.top) {
	195	if (maxline > clips[clip].c.top-1)
	196	maxline = clips[clip].c.top-1;
	197	continue;
	198	}
	199	if (maxline > clips[clip].c.top+clips[clip].c.height-1)
	200	maxline = clips[clip].c.top+clips[clip].c.height-1;
	201
	202	/* horizontal range */
	203	if (0 == skip \|\| clips[clip].c.left > skips[skip-1].end) {
	204	/* new one */
	205	skips[skip].start = clips[clip].c.left;
	206	if (skips[skip].start < 0)
	207	skips[skip].start = 0;
	208	skips[skip].end = clips[clip].c.left + clips[clip].c.width;
	209	if (skips[skip].end > width)
	210	skips[skip].end = width;
	211	skip++;
	212	} else {
	213	/* overlaps -- expand last one */
	214	end = clips[clip].c.left + clips[clip].c.width;
	215	if (skips[skip-1].end < end)
	216	skips[skip-1].end = end;
	217	if (skips[skip-1].end > width)
	218	skips[skip-1].end = width;
	219	}
	220	}
	221	*nskips = skip;
	222	*maxy = maxline;
	223
90ca8bef	224	if (btcx_debug) {
fa132a64	225	dprintk("btcx: skips line %d-%d:", line, maxline);
1da177e4	226	for (skip = 0; skip < *nskips; skip++) {
fa132a64	227	pr_cont(" %d-%d", skips[skip].start, skips[skip].end);
1da177e4	228	}
fa132a64	229	pr_cont("\n");
1da177e4 LT	230	}
1da177e4 LT	231	}