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 }; 128 129 static const struct v4l2_subdev_tuner_ops vp27smpx_tuner_ops = { 130 .s_radio = vp27smpx_s_radio, 131 .s_tuner = vp27smpx_s_tuner, 132 .g_tuner = vp27smpx_g_tuner, 133 }; 134 135 static const struct v4l2_subdev_video_ops vp27smpx_video_ops = { 136 .s_std = vp27smpx_s_std, 137 }; 138 139 static const struct v4l2_subdev_ops vp27smpx_ops = { 140 .core = &vp27smpx_core_ops, 141 .tuner = &vp27smpx_tuner_ops, 142 .video = &vp27smpx_video_ops, 143 }; 144 145 /* ----------------------------------------------------------------------- */ 146 147 /* i2c implementation */ 148 149 /* 150 * Generic i2c probe 151 * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1' 152 */ 153 154 static int vp27smpx_probe(struct i2c_client *client, 155 const struct i2c_device_id *id) 156 { 157 struct vp27smpx_state *state; 158 struct v4l2_subdev *sd; 159 160 /* Check if the adapter supports the needed features */ 161 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA)) 162 return -EIO; 163 164 v4l_info(client, "chip found @ 0x%x (%s)\n", 165 client->addr << 1, client->adapter->name); 166 167 state = devm_kzalloc(&client->dev, sizeof(*state), GFP_KERNEL); 168 if (state == NULL) 169 return -ENOMEM; 170 sd = &state->sd; 171 v4l2_i2c_subdev_init(sd, client, &vp27smpx_ops); 172 state->audmode = V4L2_TUNER_MODE_STEREO; 173 174 /* initialize vp27smpx */ 175 vp27smpx_set_audmode(sd, state->audmode); 176 return 0; 177 } 178 179 static int vp27smpx_remove(struct i2c_client *client) 180 { 181 struct v4l2_subdev *sd = i2c_get_clientdata(client); 182 183 v4l2_device_unregister_subdev(sd); 184 return 0; 185 } 186 187 /* ----------------------------------------------------------------------- */ 188 189 static const struct i2c_device_id vp27smpx_id[] = { 190 { "vp27smpx", 0 }, 191 { } 192 }; 193 MODULE_DEVICE_TABLE(i2c, vp27smpx_id); 194 195 static struct i2c_driver vp27smpx_driver = { 196 .driver = { 197 .name = "vp27smpx", 198 }, 199 .probe = vp27smpx_probe, 200 .remove = vp27smpx_remove, 201 .id_table = vp27smpx_id, 202 }; 203 204 module_i2c_driver(vp27smpx_driver); 205