1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * Driver for the Conexant CX23885/7/8 PCIe bridge
4 *
5 * Various common ioctl() support functions
6 *
7 * Copyright (c) 2009 Andy Walls <awalls@md.metrocast.net>
8 */
9
10 #include "cx23885.h"
11 #include "cx23885-ioctl.h"
12
13 #ifdef CONFIG_VIDEO_ADV_DEBUG
cx23885_g_chip_info(struct file * file,void * fh,struct v4l2_dbg_chip_info * chip)14 int cx23885_g_chip_info(struct file *file, void *fh,
15 struct v4l2_dbg_chip_info *chip)
16 {
17 struct cx23885_dev *dev = video_drvdata(file);
18
19 if (chip->match.addr > 1)
20 return -EINVAL;
21 if (chip->match.addr == 1) {
22 if (dev->v4l_device == NULL)
23 return -EINVAL;
24 strscpy(chip->name, "cx23417", sizeof(chip->name));
25 } else {
26 strscpy(chip->name, dev->v4l2_dev.name, sizeof(chip->name));
27 }
28 return 0;
29 }
30
cx23417_g_register(struct cx23885_dev * dev,struct v4l2_dbg_register * reg)31 static int cx23417_g_register(struct cx23885_dev *dev,
32 struct v4l2_dbg_register *reg)
33 {
34 u32 value;
35
36 if (dev->v4l_device == NULL)
37 return -EINVAL;
38
39 if ((reg->reg & 0x3) != 0 || reg->reg >= 0x10000)
40 return -EINVAL;
41
42 if (mc417_register_read(dev, (u16) reg->reg, &value))
43 return -EINVAL; /* V4L2 spec, but -EREMOTEIO really */
44
45 reg->size = 4;
46 reg->val = value;
47 return 0;
48 }
49
cx23885_g_register(struct file * file,void * fh,struct v4l2_dbg_register * reg)50 int cx23885_g_register(struct file *file, void *fh,
51 struct v4l2_dbg_register *reg)
52 {
53 struct cx23885_dev *dev = video_drvdata(file);
54
55 if (reg->match.addr > 1)
56 return -EINVAL;
57 if (reg->match.addr)
58 return cx23417_g_register(dev, reg);
59
60 if ((reg->reg & 0x3) != 0 || reg->reg >= pci_resource_len(dev->pci, 0))
61 return -EINVAL;
62
63 reg->size = 4;
64 reg->val = cx_read(reg->reg);
65 return 0;
66 }
67
cx23417_s_register(struct cx23885_dev * dev,const struct v4l2_dbg_register * reg)68 static int cx23417_s_register(struct cx23885_dev *dev,
69 const struct v4l2_dbg_register *reg)
70 {
71 if (dev->v4l_device == NULL)
72 return -EINVAL;
73
74 if ((reg->reg & 0x3) != 0 || reg->reg >= 0x10000)
75 return -EINVAL;
76
77 if (mc417_register_write(dev, (u16) reg->reg, (u32) reg->val))
78 return -EINVAL; /* V4L2 spec, but -EREMOTEIO really */
79 return 0;
80 }
81
cx23885_s_register(struct file * file,void * fh,const struct v4l2_dbg_register * reg)82 int cx23885_s_register(struct file *file, void *fh,
83 const struct v4l2_dbg_register *reg)
84 {
85 struct cx23885_dev *dev = video_drvdata(file);
86
87 if (reg->match.addr > 1)
88 return -EINVAL;
89 if (reg->match.addr)
90 return cx23417_s_register(dev, reg);
91
92 if ((reg->reg & 0x3) != 0 || reg->reg >= pci_resource_len(dev->pci, 0))
93 return -EINVAL;
94
95 cx_write(reg->reg, reg->val);
96 return 0;
97 }
98 #endif
99