usb/go7007/s2250-board.c

151 static int write_reg(struct i2c_client *client, u8 reg, u8 value)
153 	struct go7007 *go = i2c_get_adapdata(client->adapter);
156 	int dev_addr = client->addr << 1;  /* firmware wants 8-bit address */
171 		dev_info(&client->dev, "i2c lock failed\n");
185 static int write_reg_fp(struct i2c_client *client, u16 addr, u16 val)
187 	struct go7007 *go = i2c_get_adapdata(client->adapter);
191 	struct s2250 *dec = i2c_get_clientdata(client);
210 		dev_info(&client->dev, "i2c lock failed\n");
228 			dev_info(&client->dev, "invalid fp write %x %x\n",
233 			dev_info(&client->dev, "invalid fp write addr %x %x\n",
249 static int read_reg_fp(struct i2c_client *client, u16 addr, u16 *val)
251 	struct go7007 *go = i2c_get_adapdata(client->adapter);
272 		dev_info(&client->dev, "i2c lock failed\n");
290 static int write_regs(struct i2c_client *client, u8 *regs)
295 		if (write_reg(client, regs[i], regs[i+1]) < 0) {
296 			dev_info(&client->dev, "failed\n");
303 static int write_regs_fp(struct i2c_client *client, u16 *regs)
308 		if (write_reg_fp(client, regs[i], regs[i+1]) < 0) {
309 			dev_info(&client->dev, "failed fp\n");
323 	struct i2c_client *client = v4l2_get_subdevdata(sd);
329 		write_reg_fp(client, 0x20, 0x020 | vidsys);
330 		write_reg_fp(client, 0x21, 0x662);
331 		write_reg_fp(client, 0x140, 0x060);
334 		write_reg_fp(client, 0x20, 0x040 | vidsys);
335 		write_reg_fp(client, 0x21, 0x666);
336 		write_reg_fp(client, 0x140, 0x060);
347 	struct i2c_client *client = v4l2_get_subdevdata(sd);
352 		write_regs_fp(client, vid_regs_fp);
353 		write_regs_fp(client, vid_regs_fp_pal);
354 		write_reg_fp(client, 0x20, vidsource);
356 		write_regs_fp(client, vid_regs_fp);
357 		write_reg_fp(client, 0x20, vidsource | 1);
366 	struct i2c_client *client = v4l2_get_subdevdata(&state->sd);
371 		read_reg_fp(client, VPX322_ADDR_BRIGHTNESS0, &oldvalue);
372 		write_reg_fp(client, VPX322_ADDR_BRIGHTNESS0,
374 		read_reg_fp(client, VPX322_ADDR_BRIGHTNESS1, &oldvalue);
375 		write_reg_fp(client, VPX322_ADDR_BRIGHTNESS1,
377 		write_reg_fp(client, 0x140, 0x60);
380 		read_reg_fp(client, VPX322_ADDR_CONTRAST0, &oldvalue);
381 		write_reg_fp(client, VPX322_ADDR_CONTRAST0,
383 		read_reg_fp(client, VPX322_ADDR_CONTRAST1, &oldvalue);
384 		write_reg_fp(client, VPX322_ADDR_CONTRAST1,
386 		write_reg_fp(client, 0x140, 0x60);
389 		write_reg_fp(client, VPX322_ADDR_SAT, ctrl->val);
392 		write_reg_fp(client, VPX322_ADDR_HUE, ctrl->val);
406 	struct i2c_client *client = v4l2_get_subdevdata(sd);
415 		write_reg_fp(client, 0x12b, state->reg12b_val | 0x400);
416 		write_reg_fp(client, 0x140, 0x060);
418 		write_reg_fp(client, 0x12b, state->reg12b_val & ~0x400);
419 		write_reg_fp(client, 0x140, 0x060);
497 static int s2250_probe(struct i2c_client *client)
500 	struct i2c_adapter *adapter = client->adapter;
519 	v4l2_i2c_subdev_init(sd, client, &s2250_ops);
522 	       "Sensoray 2250/2251", client->addr, client->adapter->name);
548 		dev_err(&client->dev, "error initializing audio\n");
552 	if (write_regs(client, vid_regs) < 0) {
553 		dev_err(&client->dev, "error initializing decoder\n");
556 	if (write_regs_fp(client, vid_regs_fp) < 0) {
557 		dev_err(&client->dev, "error initializing decoder\n");
562 	write_reg_fp(client, 0x20, 0x020 | 1);
563 	write_reg_fp(client, 0x21, 0x662);
564 	write_reg_fp(client, 0x140, 0x060);
568 	write_reg(client, 0x08, 0x02); /* Line In */
603 static void s2250_remove(struct i2c_client *client)
605 	struct s2250 *state = to_state(i2c_get_clientdata(client));