2 * upd64031A - NEC Electronics Ghost Reduction for NTSC in Japan
4 * 2003 by T.Adachi <tadachi@tadachi-net.com>
5 * 2003 by Takeru KOMORIYA <komoriya@paken.org>
6 * 2006 by Hans Verkuil <hverkuil@xs4all.nl>
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.
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 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
24 #include <linux/version.h>
25 #include <linux/module.h>
26 #include <linux/kernel.h>
27 #include <linux/i2c.h>
28 #include <linux/videodev2.h>
29 #include <media/v4l2-common.h>
30 #include <media/v4l2-chip-ident.h>
31 #include <media/v4l2-i2c-drv-legacy.h>
32 #include <media/upd64031a.h>
34 // --------------------- read registers functions define -----------------------
37 #define GR_MODE_MASK 0xc0
38 #define DIRECT_3DYCS_CONNECT_MASK 0xc0
39 #define SYNC_CIRCUIT_MASK 0xa0
41 // -----------------------------------------------------------------------------
43 MODULE_DESCRIPTION("uPD64031A driver");
44 MODULE_AUTHOR("T. Adachi, Takeru KOMORIYA, Hans Verkuil");
45 MODULE_LICENSE("GPL");
48 module_param(debug
, int, 0644);
50 MODULE_PARM_DESC(debug
, "Debug level (0-1)");
52 static unsigned short normal_i2c
[] = { 0x24 >> 1, 0x26 >> 1, I2C_CLIENT_END
};
58 R00
= 0, R01
, R02
, R03
, R04
,
59 R05
, R06
, R07
, R08
, R09
,
60 R0A
, R0B
, R0C
, R0D
, R0E
, R0F
,
62 R10, R11, R12, R13, R14,
68 struct upd64031a_state
{
71 u8 direct_3dycs_connect
;
76 static u8 upd64031a_init
[] = {
77 0x00, 0xb8, 0x48, 0xd2, 0xe6,
78 0x03, 0x10, 0x0b, 0xaf, 0x7f,
79 0x00, 0x00, 0x1d, 0x5e, 0x00,
83 /* ------------------------------------------------------------------------ */
85 static u8
upd64031a_read(struct i2c_client
*client
, u8 reg
)
89 if (reg
>= sizeof(buf
))
91 i2c_master_recv(client
, buf
, 2);
95 /* ------------------------------------------------------------------------ */
97 static void upd64031a_write(struct i2c_client
*client
, u8 reg
, u8 val
)
103 v4l_dbg(1, debug
, client
, "writing reg addr: %02X val: %02X\n", reg
, val
);
104 if (i2c_master_send(client
, buf
, 2) != 2)
105 v4l_err(client
, "I/O error write 0x%02x/0x%02x\n", reg
, val
);
108 /* ------------------------------------------------------------------------ */
110 /* The input changed due to new input or channel changed */
111 static void upd64031a_change(struct i2c_client
*client
)
113 struct upd64031a_state
*state
= i2c_get_clientdata(client
);
114 u8 reg
= state
->regs
[R00
];
116 v4l_dbg(1, debug
, client
, "changed input or channel\n");
117 upd64031a_write(client
, R00
, reg
| 0x10);
118 upd64031a_write(client
, R00
, reg
& ~0x10);
121 /* ------------------------------------------------------------------------ */
123 static int upd64031a_command(struct i2c_client
*client
, unsigned int cmd
, void *arg
)
125 struct upd64031a_state
*state
= i2c_get_clientdata(client
);
126 struct v4l2_routing
*route
= arg
;
129 case VIDIOC_S_FREQUENCY
:
130 upd64031a_change(client
);
133 case VIDIOC_INT_G_VIDEO_ROUTING
:
134 route
->input
= (state
->gr_mode
>> 6) |
135 (state
->direct_3dycs_connect
>> 4) |
136 (state
->ext_comp_sync
>> 1) |
137 (state
->ext_vert_sync
>> 2);
141 case VIDIOC_INT_S_VIDEO_ROUTING
:
145 state
->gr_mode
= (route
->input
& 3) << 6;
146 state
->direct_3dycs_connect
= (route
->input
& 0xc) << 4;
147 state
->ext_comp_sync
= (route
->input
& UPD64031A_COMPOSITE_EXTERNAL
) << 1;
148 state
->ext_vert_sync
= (route
->input
& UPD64031A_VERTICAL_EXTERNAL
) << 2;
149 r00
= (state
->regs
[R00
] & ~GR_MODE_MASK
) | state
->gr_mode
;
150 r05
= (state
->regs
[R00
] & ~SYNC_CIRCUIT_MASK
) |
151 state
->ext_comp_sync
| state
->ext_vert_sync
;
152 r08
= (state
->regs
[R08
] & ~DIRECT_3DYCS_CONNECT_MASK
) |
153 state
->direct_3dycs_connect
;
154 upd64031a_write(client
, R00
, r00
);
155 upd64031a_write(client
, R05
, r05
);
156 upd64031a_write(client
, R08
, r08
);
157 upd64031a_change(client
);
161 case VIDIOC_LOG_STATUS
:
162 v4l_info(client
, "Status: SA00=0x%02x SA01=0x%02x\n",
163 upd64031a_read(client
, 0), upd64031a_read(client
, 1));
166 #ifdef CONFIG_VIDEO_ADV_DEBUG
167 case VIDIOC_DBG_G_REGISTER
:
168 case VIDIOC_DBG_S_REGISTER
:
170 struct v4l2_register
*reg
= arg
;
172 if (!v4l2_chip_match_i2c_client(client
, reg
->match_type
, reg
->match_chip
))
174 if (!capable(CAP_SYS_ADMIN
))
176 if (cmd
== VIDIOC_DBG_G_REGISTER
)
177 reg
->val
= upd64031a_read(client
, reg
->reg
& 0xff);
179 upd64031a_write(client
, reg
->reg
& 0xff, reg
->val
& 0xff);
184 case VIDIOC_G_CHIP_IDENT
:
185 return v4l2_chip_ident_i2c_client(client
, arg
, V4L2_IDENT_UPD64031A
, 0);
193 /* ------------------------------------------------------------------------ */
195 /* i2c implementation */
197 static int upd64031a_probe(struct i2c_client
*client
)
199 struct upd64031a_state
*state
;
202 if (!i2c_check_functionality(client
->adapter
, I2C_FUNC_SMBUS_BYTE_DATA
))
205 v4l_info(client
, "chip found @ 0x%x (%s)\n", client
->addr
<< 1, client
->adapter
->name
);
207 state
= kmalloc(sizeof(struct upd64031a_state
), GFP_KERNEL
);
211 i2c_set_clientdata(client
, state
);
212 memcpy(state
->regs
, upd64031a_init
, sizeof(state
->regs
));
213 state
->gr_mode
= UPD64031A_GR_ON
<< 6;
214 state
->direct_3dycs_connect
= UPD64031A_3DYCS_COMPOSITE
<< 4;
215 state
->ext_comp_sync
= state
->ext_vert_sync
= 0;
216 for (i
= 0; i
< TOT_REGS
; i
++) {
217 upd64031a_write(client
, i
, state
->regs
[i
]);
222 static int upd64031a_remove(struct i2c_client
*client
)
224 kfree(i2c_get_clientdata(client
));
228 /* ----------------------------------------------------------------------- */
231 static struct v4l2_i2c_driver_data v4l2_i2c_data
= {
233 .driverid
= I2C_DRIVERID_UPD64031A
,
234 .command
= upd64031a_command
,
235 .probe
= upd64031a_probe
,
236 .remove
= upd64031a_remove
,