1 /* 2 * vp27smpx - driver version 0.0.1 3 * 4 * Copyright (C) 2007 Hans Verkuil <hverkuil@xs4all.nl> 5 * 6 * Based on a tvaudio patch from Takahiro Adachi <tadachi@tadachi-net.com> 7 * and Kazuhiko Kawakami <kazz-0@mail.goo.ne.jp> 8 * 9 * This program is free software; you can redistribute it and/or modify 10 * it under the terms of the GNU General Public License as published by 11 * the Free Software Foundation; either version 2 of the License, or 12 * (at your option) any later version. 13 * 14 * This program is distributed in the hope that it will be useful, 15 * but WITHOUT ANY WARRANTY; without even the implied warranty of 16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 17 * GNU General Public License for more details. 18 * 19 * You should have received a copy of the GNU General Public License 20 * along with this program; if not, write to the Free Software 21 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 22 */ 23 24 #include <linux/module.h> 25 #include <linux/types.h> 26 #include <linux/slab.h> 27 #include <linux/ioctl.h> 28 #include <asm/uaccess.h> 29 #include <linux/i2c.h> 30 #include <linux/videodev2.h> 31 #include <media/v4l2-device.h> 32 33 MODULE_DESCRIPTION("vp27smpx driver"); 34 MODULE_AUTHOR("Hans Verkuil"); 35 MODULE_LICENSE("GPL"); 36 37 38 /* ----------------------------------------------------------------------- */ 39 40 struct vp27smpx_state { 41 struct v4l2_subdev sd; 42 int radio; 43 u32 audmode; 44 }; 45 46 static inline struct vp27smpx_state *to_state(struct v4l2_subdev *sd) 47 { 48 return container_of(sd, struct vp27smpx_state, sd); 49 } 50 51 static void vp27smpx_set_audmode(struct v4l2_subdev *sd, u32 audmode) 52 { 53 struct vp27smpx_state *state = to_state(sd); 54 struct i2c_client *client = v4l2_get_subdevdata(sd); 55 u8 data[3] = { 0x00, 0x00, 0x04 }; 56 57 switch (audmode) { 58 case V4L2_TUNER_MODE_MONO: 59 case V4L2_TUNER_MODE_LANG1: 60 break; 61 case V4L2_TUNER_MODE_STEREO: 62 case V4L2_TUNER_MODE_LANG1_LANG2: 63 data[1] = 0x01; 64 break; 65 case V4L2_TUNER_MODE_LANG2: 66 data[1] = 0x02; 67 break; 68 } 69 70 if (i2c_master_send(client, data, sizeof(data)) != sizeof(data)) 71 v4l2_err(sd, "I/O error setting audmode\n"); 72 else 73 state->audmode = audmode; 74 } 75 76 static int vp27smpx_s_radio(struct v4l2_subdev *sd) 77 { 78 struct vp27smpx_state *state = to_state(sd); 79 80 state->radio = 1; 81 return 0; 82 } 83 84 static int vp27smpx_s_std(struct v4l2_subdev *sd, v4l2_std_id norm) 85 { 86 struct vp27smpx_state *state = to_state(sd); 87 88 state->radio = 0; 89 return 0; 90 } 91 92 static int vp27smpx_s_tuner(struct v4l2_subdev *sd, const struct v4l2_tuner *vt) 93 { 94 struct vp27smpx_state *state = to_state(sd); 95 96 if (!state->radio) 97 vp27smpx_set_audmode(sd, vt->audmode); 98 return 0; 99 } 100 101 static int vp27smpx_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt) 102 { 103 struct vp27smpx_state *state = to_state(sd); 104 105 if (state->radio) 106 return 0; 107 vt->audmode = state->audmode; 108 vt->capability = V4L2_TUNER_CAP_STEREO | 109 V4L2_TUNER_CAP_LANG1 | V4L2_TUNER_CAP_LANG2; 110 vt->rxsubchans = V4L2_TUNER_SUB_MONO; 111 return 0; 112 } 113 114 static int vp27smpx_log_status(struct v4l2_subdev *sd) 115 { 116 struct vp27smpx_state *state = to_state(sd); 117 118 v4l2_info(sd, "Audio Mode: %u%s\n", state->audmode, 119 state->radio ? " (Radio)" : ""); 120 return 0; 121 } 122 123 /* ----------------------------------------------------------------------- */ 124 125 static const struct v4l2_subdev_core_ops vp27smpx_core_ops = { 126 .log_status = vp27smpx_log_status, 127 .s_std = vp27smpx_s_std, 128 }; 129 130 static const struct v4l2_subdev_tuner_ops vp27smpx_tuner_ops = { 131 .s_radio = vp27smpx_s_radio, 132 .s_tuner = vp27smpx_s_tuner, 133 .g_tuner = vp27smpx_g_tuner, 134 }; 135 136 static const struct v4l2_subdev_ops vp27smpx_ops = { 137 .core = &vp27smpx_core_ops, 138 .tuner = &vp27smpx_tuner_ops, 139 }; 140 141 /* ----------------------------------------------------------------------- */ 142 143 /* i2c implementation */ 144 145 /* 146 * Generic i2c probe 147 * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1' 148 */ 149 150 static int vp27smpx_probe(struct i2c_client *client, 151 const struct i2c_device_id *id) 152 { 153 struct vp27smpx_state *state; 154 struct v4l2_subdev *sd; 155 156 /* Check if the adapter supports the needed features */ 157 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA)) 158 return -EIO; 159 160 v4l_info(client, "chip found @ 0x%x (%s)\n", 161 client->addr << 1, client->adapter->name); 162 163 state = devm_kzalloc(&client->dev, sizeof(*state), GFP_KERNEL); 164 if (state == NULL) 165 return -ENOMEM; 166 sd = &state->sd; 167 v4l2_i2c_subdev_init(sd, client, &vp27smpx_ops); 168 state->audmode = V4L2_TUNER_MODE_STEREO; 169 170 /* initialize vp27smpx */ 171 vp27smpx_set_audmode(sd, state->audmode); 172 return 0; 173 } 174 175 static int vp27smpx_remove(struct i2c_client *client) 176 { 177 struct v4l2_subdev *sd = i2c_get_clientdata(client); 178 179 v4l2_device_unregister_subdev(sd); 180 return 0; 181 } 182 183 /* ----------------------------------------------------------------------- */ 184 185 static const struct i2c_device_id vp27smpx_id[] = { 186 { "vp27smpx", 0 }, 187 { } 188 }; 189 MODULE_DEVICE_TABLE(i2c, vp27smpx_id); 190 191 static struct i2c_driver vp27smpx_driver = { 192 .driver = { 193 .owner = THIS_MODULE, 194 .name = "vp27smpx", 195 }, 196 .probe = vp27smpx_probe, 197 .remove = vp27smpx_remove, 198 .id_table = vp27smpx_id, 199 }; 200 201 module_i2c_driver(vp27smpx_driver); 202