1 /*
2  *  Driver for the Conexant CX23885/7/8 PCIe bridge
3  *
4  *  Various common ioctl() support functions
5  *
6  *  Copyright (c) 2009 Andy Walls <awalls@md.metrocast.net>
7  *
8  *  This program is free software; you can redistribute it and/or modify
9  *  it under the terms of the GNU General Public License as published by
10  *  the Free Software Foundation; either version 2 of the License, or
11  *  (at your option) any later version.
12  *
13  *  This program is distributed in the hope that it will be useful,
14  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  *
17  *  GNU General Public License for more details.
18  */
19 
20 #include "cx23885.h"
21 #include "cx23885-ioctl.h"
22 
23 #ifdef CONFIG_VIDEO_ADV_DEBUG
24 int cx23885_g_chip_info(struct file *file, void *fh,
25 			 struct v4l2_dbg_chip_info *chip)
26 {
27 	struct cx23885_dev *dev = video_drvdata(file);
28 
29 	if (chip->match.addr > 1)
30 		return -EINVAL;
31 	if (chip->match.addr == 1) {
32 		if (dev->v4l_device == NULL)
33 			return -EINVAL;
34 		strlcpy(chip->name, "cx23417", sizeof(chip->name));
35 	} else {
36 		strlcpy(chip->name, dev->v4l2_dev.name, sizeof(chip->name));
37 	}
38 	return 0;
39 }
40 
41 static int cx23417_g_register(struct cx23885_dev *dev,
42 			      struct v4l2_dbg_register *reg)
43 {
44 	u32 value;
45 
46 	if (dev->v4l_device == NULL)
47 		return -EINVAL;
48 
49 	if ((reg->reg & 0x3) != 0 || reg->reg >= 0x10000)
50 		return -EINVAL;
51 
52 	if (mc417_register_read(dev, (u16) reg->reg, &value))
53 		return -EINVAL; /* V4L2 spec, but -EREMOTEIO really */
54 
55 	reg->size = 4;
56 	reg->val = value;
57 	return 0;
58 }
59 
60 int cx23885_g_register(struct file *file, void *fh,
61 		       struct v4l2_dbg_register *reg)
62 {
63 	struct cx23885_dev *dev = video_drvdata(file);
64 
65 	if (reg->match.addr > 1)
66 		return -EINVAL;
67 	if (reg->match.addr)
68 		return cx23417_g_register(dev, reg);
69 
70 	if ((reg->reg & 0x3) != 0 || reg->reg >= pci_resource_len(dev->pci, 0))
71 		return -EINVAL;
72 
73 	reg->size = 4;
74 	reg->val = cx_read(reg->reg);
75 	return 0;
76 }
77 
78 static int cx23417_s_register(struct cx23885_dev *dev,
79 			      const struct v4l2_dbg_register *reg)
80 {
81 	if (dev->v4l_device == NULL)
82 		return -EINVAL;
83 
84 	if ((reg->reg & 0x3) != 0 || reg->reg >= 0x10000)
85 		return -EINVAL;
86 
87 	if (mc417_register_write(dev, (u16) reg->reg, (u32) reg->val))
88 		return -EINVAL; /* V4L2 spec, but -EREMOTEIO really */
89 	return 0;
90 }
91 
92 int cx23885_s_register(struct file *file, void *fh,
93 		       const struct v4l2_dbg_register *reg)
94 {
95 	struct cx23885_dev *dev = video_drvdata(file);
96 
97 	if (reg->match.addr > 1)
98 		return -EINVAL;
99 	if (reg->match.addr)
100 		return cx23417_s_register(dev, reg);
101 
102 	if ((reg->reg & 0x3) != 0 || reg->reg >= pci_resource_len(dev->pci, 0))
103 		return -EINVAL;
104 
105 	cx_write(reg->reg, reg->val);
106 	return 0;
107 }
108 #endif
109