1 /* 2 * upd64031A - NEC Electronics Ghost Reduction for NTSC in Japan 3 * 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> 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 * GNU General Public License for more details. 17 */ 18 19 20 #include <linux/module.h> 21 #include <linux/kernel.h> 22 #include <linux/i2c.h> 23 #include <linux/videodev2.h> 24 #include <linux/slab.h> 25 #include <media/v4l2-device.h> 26 #include <media/i2c/upd64031a.h> 27 28 /* --------------------- read registers functions define -------------------- */ 29 30 /* bit masks */ 31 #define GR_MODE_MASK 0xc0 32 #define DIRECT_3DYCS_CONNECT_MASK 0xc0 33 #define SYNC_CIRCUIT_MASK 0xa0 34 35 /* -------------------------------------------------------------------------- */ 36 37 MODULE_DESCRIPTION("uPD64031A driver"); 38 MODULE_AUTHOR("T. Adachi, Takeru KOMORIYA, Hans Verkuil"); 39 MODULE_LICENSE("GPL"); 40 41 static int debug; 42 module_param(debug, int, 0644); 43 44 MODULE_PARM_DESC(debug, "Debug level (0-1)"); 45 46 47 enum { 48 R00 = 0, R01, R02, R03, R04, 49 R05, R06, R07, R08, R09, 50 R0A, R0B, R0C, R0D, R0E, R0F, 51 /* unused registers 52 R10, R11, R12, R13, R14, 53 R15, R16, R17, 54 */ 55 TOT_REGS 56 }; 57 58 struct upd64031a_state { 59 struct v4l2_subdev sd; 60 u8 regs[TOT_REGS]; 61 u8 gr_mode; 62 u8 direct_3dycs_connect; 63 u8 ext_comp_sync; 64 u8 ext_vert_sync; 65 }; 66 67 static inline struct upd64031a_state *to_state(struct v4l2_subdev *sd) 68 { 69 return container_of(sd, struct upd64031a_state, sd); 70 } 71 72 static u8 upd64031a_init[] = { 73 0x00, 0xb8, 0x48, 0xd2, 0xe6, 74 0x03, 0x10, 0x0b, 0xaf, 0x7f, 75 0x00, 0x00, 0x1d, 0x5e, 0x00, 76 0xd0 77 }; 78 79 /* ------------------------------------------------------------------------ */ 80 81 static u8 upd64031a_read(struct v4l2_subdev *sd, u8 reg) 82 { 83 struct i2c_client *client = v4l2_get_subdevdata(sd); 84 u8 buf[2]; 85 86 if (reg >= sizeof(buf)) 87 return 0xff; 88 i2c_master_recv(client, buf, 2); 89 return buf[reg]; 90 } 91 92 /* ------------------------------------------------------------------------ */ 93 94 static void upd64031a_write(struct v4l2_subdev *sd, u8 reg, u8 val) 95 { 96 struct i2c_client *client = v4l2_get_subdevdata(sd); 97 u8 buf[2]; 98 99 buf[0] = reg; 100 buf[1] = val; 101 v4l2_dbg(1, debug, sd, "write reg: %02X val: %02X\n", reg, val); 102 if (i2c_master_send(client, buf, 2) != 2) 103 v4l2_err(sd, "I/O error write 0x%02x/0x%02x\n", reg, val); 104 } 105 106 /* ------------------------------------------------------------------------ */ 107 108 /* The input changed due to new input or channel changed */ 109 static int upd64031a_s_frequency(struct v4l2_subdev *sd, const struct v4l2_frequency *freq) 110 { 111 struct upd64031a_state *state = to_state(sd); 112 u8 reg = state->regs[R00]; 113 114 v4l2_dbg(1, debug, sd, "changed input or channel\n"); 115 upd64031a_write(sd, R00, reg | 0x10); 116 upd64031a_write(sd, R00, reg & ~0x10); 117 return 0; 118 } 119 120 /* ------------------------------------------------------------------------ */ 121 122 static int upd64031a_s_routing(struct v4l2_subdev *sd, 123 u32 input, u32 output, u32 config) 124 { 125 struct upd64031a_state *state = to_state(sd); 126 u8 r00, r05, r08; 127 128 state->gr_mode = (input & 3) << 6; 129 state->direct_3dycs_connect = (input & 0xc) << 4; 130 state->ext_comp_sync = 131 (input & UPD64031A_COMPOSITE_EXTERNAL) << 1; 132 state->ext_vert_sync = 133 (input & UPD64031A_VERTICAL_EXTERNAL) << 2; 134 r00 = (state->regs[R00] & ~GR_MODE_MASK) | state->gr_mode; 135 r05 = (state->regs[R00] & ~SYNC_CIRCUIT_MASK) | 136 state->ext_comp_sync | state->ext_vert_sync; 137 r08 = (state->regs[R08] & ~DIRECT_3DYCS_CONNECT_MASK) | 138 state->direct_3dycs_connect; 139 upd64031a_write(sd, R00, r00); 140 upd64031a_write(sd, R05, r05); 141 upd64031a_write(sd, R08, r08); 142 return upd64031a_s_frequency(sd, NULL); 143 } 144 145 static int upd64031a_log_status(struct v4l2_subdev *sd) 146 { 147 v4l2_info(sd, "Status: SA00=0x%02x SA01=0x%02x\n", 148 upd64031a_read(sd, 0), upd64031a_read(sd, 1)); 149 return 0; 150 } 151 152 #ifdef CONFIG_VIDEO_ADV_DEBUG 153 static int upd64031a_g_register(struct v4l2_subdev *sd, struct v4l2_dbg_register *reg) 154 { 155 reg->val = upd64031a_read(sd, reg->reg & 0xff); 156 reg->size = 1; 157 return 0; 158 } 159 160 static int upd64031a_s_register(struct v4l2_subdev *sd, const struct v4l2_dbg_register *reg) 161 { 162 upd64031a_write(sd, reg->reg & 0xff, reg->val & 0xff); 163 return 0; 164 } 165 #endif 166 167 /* ----------------------------------------------------------------------- */ 168 169 static const struct v4l2_subdev_core_ops upd64031a_core_ops = { 170 .log_status = upd64031a_log_status, 171 #ifdef CONFIG_VIDEO_ADV_DEBUG 172 .g_register = upd64031a_g_register, 173 .s_register = upd64031a_s_register, 174 #endif 175 }; 176 177 static const struct v4l2_subdev_tuner_ops upd64031a_tuner_ops = { 178 .s_frequency = upd64031a_s_frequency, 179 }; 180 181 static const struct v4l2_subdev_video_ops upd64031a_video_ops = { 182 .s_routing = upd64031a_s_routing, 183 }; 184 185 static const struct v4l2_subdev_ops upd64031a_ops = { 186 .core = &upd64031a_core_ops, 187 .tuner = &upd64031a_tuner_ops, 188 .video = &upd64031a_video_ops, 189 }; 190 191 /* ------------------------------------------------------------------------ */ 192 193 /* i2c implementation */ 194 195 static int upd64031a_probe(struct i2c_client *client, 196 const struct i2c_device_id *id) 197 { 198 struct upd64031a_state *state; 199 struct v4l2_subdev *sd; 200 int i; 201 202 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA)) 203 return -EIO; 204 205 v4l_info(client, "chip found @ 0x%x (%s)\n", 206 client->addr << 1, client->adapter->name); 207 208 state = devm_kzalloc(&client->dev, sizeof(*state), GFP_KERNEL); 209 if (state == NULL) 210 return -ENOMEM; 211 sd = &state->sd; 212 v4l2_i2c_subdev_init(sd, client, &upd64031a_ops); 213 memcpy(state->regs, upd64031a_init, sizeof(state->regs)); 214 state->gr_mode = UPD64031A_GR_ON << 6; 215 state->direct_3dycs_connect = UPD64031A_3DYCS_COMPOSITE << 4; 216 state->ext_comp_sync = state->ext_vert_sync = 0; 217 for (i = 0; i < TOT_REGS; i++) 218 upd64031a_write(sd, i, state->regs[i]); 219 return 0; 220 } 221 222 static int upd64031a_remove(struct i2c_client *client) 223 { 224 struct v4l2_subdev *sd = i2c_get_clientdata(client); 225 226 v4l2_device_unregister_subdev(sd); 227 return 0; 228 } 229 230 /* ----------------------------------------------------------------------- */ 231 232 static const struct i2c_device_id upd64031a_id[] = { 233 { "upd64031a", 0 }, 234 { } 235 }; 236 MODULE_DEVICE_TABLE(i2c, upd64031a_id); 237 238 static struct i2c_driver upd64031a_driver = { 239 .driver = { 240 .name = "upd64031a", 241 }, 242 .probe = upd64031a_probe, 243 .remove = upd64031a_remove, 244 .id_table = upd64031a_id, 245 }; 246 247 module_i2c_driver(upd64031a_driver); 248