xref: /OK3568_Linux_fs/kernel/drivers/media/pci/tw5864/tw5864-util.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun #include "tw5864.h"
3*4882a593Smuzhiyun 
tw5864_indir_writeb(struct tw5864_dev * dev,u16 addr,u8 data)4*4882a593Smuzhiyun void tw5864_indir_writeb(struct tw5864_dev *dev, u16 addr, u8 data)
5*4882a593Smuzhiyun {
6*4882a593Smuzhiyun 	int retries = 30000;
7*4882a593Smuzhiyun 
8*4882a593Smuzhiyun 	while (tw_readl(TW5864_IND_CTL) & BIT(31) && --retries)
9*4882a593Smuzhiyun 		;
10*4882a593Smuzhiyun 	if (!retries)
11*4882a593Smuzhiyun 		dev_err(&dev->pci->dev,
12*4882a593Smuzhiyun 			"tw_indir_writel() retries exhausted before writing\n");
13*4882a593Smuzhiyun 
14*4882a593Smuzhiyun 	tw_writel(TW5864_IND_DATA, data);
15*4882a593Smuzhiyun 	tw_writel(TW5864_IND_CTL, addr << 2 | TW5864_RW | TW5864_ENABLE);
16*4882a593Smuzhiyun }
17*4882a593Smuzhiyun 
tw5864_indir_readb(struct tw5864_dev * dev,u16 addr)18*4882a593Smuzhiyun u8 tw5864_indir_readb(struct tw5864_dev *dev, u16 addr)
19*4882a593Smuzhiyun {
20*4882a593Smuzhiyun 	int retries = 30000;
21*4882a593Smuzhiyun 
22*4882a593Smuzhiyun 	while (tw_readl(TW5864_IND_CTL) & BIT(31) && --retries)
23*4882a593Smuzhiyun 		;
24*4882a593Smuzhiyun 	if (!retries)
25*4882a593Smuzhiyun 		dev_err(&dev->pci->dev,
26*4882a593Smuzhiyun 			"tw_indir_readl() retries exhausted before reading\n");
27*4882a593Smuzhiyun 
28*4882a593Smuzhiyun 	tw_writel(TW5864_IND_CTL, addr << 2 | TW5864_ENABLE);
29*4882a593Smuzhiyun 
30*4882a593Smuzhiyun 	retries = 30000;
31*4882a593Smuzhiyun 	while (tw_readl(TW5864_IND_CTL) & BIT(31) && --retries)
32*4882a593Smuzhiyun 		;
33*4882a593Smuzhiyun 	if (!retries)
34*4882a593Smuzhiyun 		dev_err(&dev->pci->dev,
35*4882a593Smuzhiyun 			"tw_indir_readl() retries exhausted at reading\n");
36*4882a593Smuzhiyun 
37*4882a593Smuzhiyun 	return tw_readl(TW5864_IND_DATA);
38*4882a593Smuzhiyun }
39