159 static int write_reg(struct i2c_client *client, u8 reg, u8 value)  in write_reg()  argument
161 	struct go7007 *go = i2c_get_adapdata(client->adapter);  in write_reg()
164 	int dev_addr = client->addr << 1;  /* firmware wants 8-bit address */  in write_reg()
179 		dev_info(&client->dev, "i2c lock failed\n");  in write_reg()
193 static int write_reg_fp(struct i2c_client *client, u16 addr, u16 val)  in write_reg_fp()  argument
195 	struct go7007 *go = i2c_get_adapdata(client->adapter);  in write_reg_fp()
199 	struct s2250 *dec = i2c_get_clientdata(client);  in write_reg_fp()
218 		dev_info(&client->dev, "i2c lock failed\n");  in write_reg_fp()
236 			dev_info(&client->dev, "invalid fp write %x %x\n",  in write_reg_fp()
241 			dev_info(&client->dev, "invalid fp write addr %x %x\n",  in write_reg_fp()
257 static int read_reg_fp(struct i2c_client *client, u16 addr, u16 *val)  in read_reg_fp()  argument
259 	struct go7007 *go = i2c_get_adapdata(client->adapter);  in read_reg_fp()
280 		dev_info(&client->dev, "i2c lock failed\n");  in read_reg_fp()
298 static int write_regs(struct i2c_client *client, u8 *regs)  in write_regs()  argument
303 		if (write_reg(client, regs[i], regs[i+1]) < 0) {  in write_regs()
304 			dev_info(&client->dev, "failed\n");  in write_regs()
311 static int write_regs_fp(struct i2c_client *client, u16 *regs)  in write_regs_fp()  argument
316 		if (write_reg_fp(client, regs[i], regs[i+1]) < 0) {  in write_regs_fp()
317 			dev_info(&client->dev, "failed fp\n");  in write_regs_fp()
331 	struct i2c_client *client = v4l2_get_subdevdata(sd);  in s2250_s_video_routing()  local
337 		write_reg_fp(client, 0x20, 0x020 | vidsys);  in s2250_s_video_routing()
338 		write_reg_fp(client, 0x21, 0x662);  in s2250_s_video_routing()
339 		write_reg_fp(client, 0x140, 0x060);  in s2250_s_video_routing()
342 		write_reg_fp(client, 0x20, 0x040 | vidsys);  in s2250_s_video_routing()
343 		write_reg_fp(client, 0x21, 0x666);  in s2250_s_video_routing()
344 		write_reg_fp(client, 0x140, 0x060);  in s2250_s_video_routing()
355 	struct i2c_client *client = v4l2_get_subdevdata(sd);  in s2250_s_std()  local
360 		write_regs_fp(client, vid_regs_fp);  in s2250_s_std()
361 		write_regs_fp(client, vid_regs_fp_pal);  in s2250_s_std()
362 		write_reg_fp(client, 0x20, vidsource);  in s2250_s_std()
364 		write_regs_fp(client, vid_regs_fp);  in s2250_s_std()
365 		write_reg_fp(client, 0x20, vidsource | 1);  in s2250_s_std()
374 	struct i2c_client *client = v4l2_get_subdevdata(&state->sd);  in s2250_s_ctrl()  local
379 		read_reg_fp(client, VPX322_ADDR_BRIGHTNESS0, &oldvalue);  in s2250_s_ctrl()
380 		write_reg_fp(client, VPX322_ADDR_BRIGHTNESS0,  in s2250_s_ctrl()
382 		read_reg_fp(client, VPX322_ADDR_BRIGHTNESS1, &oldvalue);  in s2250_s_ctrl()
383 		write_reg_fp(client, VPX322_ADDR_BRIGHTNESS1,  in s2250_s_ctrl()
385 		write_reg_fp(client, 0x140, 0x60);  in s2250_s_ctrl()
388 		read_reg_fp(client, VPX322_ADDR_CONTRAST0, &oldvalue);  in s2250_s_ctrl()
389 		write_reg_fp(client, VPX322_ADDR_CONTRAST0,  in s2250_s_ctrl()
391 		read_reg_fp(client, VPX322_ADDR_CONTRAST1, &oldvalue);  in s2250_s_ctrl()
392 		write_reg_fp(client, VPX322_ADDR_CONTRAST1,  in s2250_s_ctrl()
394 		write_reg_fp(client, 0x140, 0x60);  in s2250_s_ctrl()
397 		write_reg_fp(client, VPX322_ADDR_SAT, ctrl->val);  in s2250_s_ctrl()
400 		write_reg_fp(client, VPX322_ADDR_HUE, ctrl->val);  in s2250_s_ctrl()
412 	struct i2c_client *client = v4l2_get_subdevdata(sd);  in s2250_s_mbus_fmt()  local
415 		write_reg_fp(client, 0x12b, state->reg12b_val | 0x400);  in s2250_s_mbus_fmt()
416 		write_reg_fp(client, 0x140, 0x060);  in s2250_s_mbus_fmt()
418 		write_reg_fp(client, 0x12b, state->reg12b_val & ~0x400);  in s2250_s_mbus_fmt()
419 		write_reg_fp(client, 0x140, 0x060);  in s2250_s_mbus_fmt()
493 static int s2250_probe(struct i2c_client *client,  in s2250_probe()  argument
497 	struct i2c_adapter *adapter = client->adapter;  in s2250_probe()
515 	v4l2_i2c_subdev_init(sd, client, &s2250_ops);  in s2250_probe()
518 	       "Sensoray 2250/2251", client->addr, client->adapter->name);  in s2250_probe()
547 		dev_err(&client->dev, "error initializing audio\n");  in s2250_probe()
551 	if (write_regs(client, vid_regs) < 0) {  in s2250_probe()
552 		dev_err(&client->dev, "error initializing decoder\n");  in s2250_probe()
555 	if (write_regs_fp(client, vid_regs_fp) < 0) {  in s2250_probe()
556 		dev_err(&client->dev, "error initializing decoder\n");  in s2250_probe()
561 	write_reg_fp(client, 0x20, 0x020 | 1);  in s2250_probe()
562 	write_reg_fp(client, 0x21, 0x662);  in s2250_probe()
563 	write_reg_fp(client, 0x140, 0x060);  in s2250_probe()
567 	write_reg(client, 0x08, 0x02); /* Line In */  in s2250_probe()
602 static int s2250_remove(struct i2c_client *client)  in s2250_remove()  argument
604 	struct s2250 *state = to_state(i2c_get_clientdata(client));  in s2250_remove()