kernel/drivers/media/i2c/ak881x.c

   1 /*
   2  * Driver for AK8813 / AK8814 TV-ecoders from Asahi Kasei Microsystems Co., Ltd. (AKM)
   3  *
   4  * Copyright (C) 2010, Guennadi Liakhovetski <g.liakhovetski@gmx.de>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 as
   8  * published by the Free Software Foundation.
   9  */
  10
  11 #include <linux/i2c.h>
  12 #include <linux/init.h>
  13 #include <linux/platform_device.h>
  14 #include <linux/slab.h>
  15 #include <linux/videodev2.h>
  16 #include <linux/module.h>
  17
  18 #include <media/ak881x.h>
  19 #include <media/v4l2-common.h>
  20 #include <media/v4l2-device.h>
  21
  22 #define AK881X_INTERFACE_MODE   0
  23 #define AK881X_VIDEO_PROCESS1   1
  24 #define AK881X_VIDEO_PROCESS2   2
  25 #define AK881X_VIDEO_PROCESS3   3
  26 #define AK881X_DAC_MODE         5
  27 #define AK881X_STATUS           0x24
  28 #define AK881X_DEVICE_ID        0x25
  29 #define AK881X_DEVICE_REVISION  0x26
  30
  31 struct ak881x {
  32         struct v4l2_subdev subdev;
  33         struct ak881x_pdata *pdata;
  34         unsigned int lines;
  35         char revision;  /* DEVICE_REVISION content */
  36 };
  37
  38 static int reg_read(struct i2c_client *client, const u8 reg)
  39 {
  40         return i2c_smbus_read_byte_data(client, reg);
  41 }
  42
  43 static int reg_write(struct i2c_client *client, const u8 reg,
  44                      const u8 data)
  45 {
  46         return i2c_smbus_write_byte_data(client, reg, data);
  47 }
  48
  49 static int reg_set(struct i2c_client *client, const u8 reg,
  50                    const u8 data, u8 mask)
  51 {
  52         int ret = reg_read(client, reg);
  53         if (ret < 0)
  54                 return ret;
  55         return reg_write(client, reg, (ret & ~mask) | (data & mask));
  56 }
  57
  58 static struct ak881x *to_ak881x(const struct i2c_client *client)
  59 {
  60         return container_of(i2c_get_clientdata(client), struct ak881x, subdev);
  61 }
  62
  63 #ifdef CONFIG_VIDEO_ADV_DEBUG
  64 static int ak881x_g_register(struct v4l2_subdev *sd,
  65                              struct v4l2_dbg_register *reg)
  66 {
  67         struct i2c_client *client = v4l2_get_subdevdata(sd);
  68
  69         if (reg->reg > 0x26)
  70                 return -EINVAL;
  71
  72         reg->size = 1;
  73         reg->val = reg_read(client, reg->reg);
  74
  75         if (reg->val > 0xffff)
  76                 return -EIO;
  77
  78         return 0;
  79 }
  80
  81 static int ak881x_s_register(struct v4l2_subdev *sd,
  82                              const struct v4l2_dbg_register *reg)
  83 {
  84         struct i2c_client *client = v4l2_get_subdevdata(sd);
  85
  86         if (reg->reg > 0x26)
  87                 return -EINVAL;
  88
  89         if (reg_write(client, reg->reg, reg->val) < 0)
  90                 return -EIO;
  91
  92         return 0;
  93 }
  94 #endif
  95
  96 static int ak881x_try_g_mbus_fmt(struct v4l2_subdev *sd,
  97                                  struct v4l2_mbus_framefmt *mf)
  98 {
  99         struct i2c_client *client = v4l2_get_subdevdata(sd);
 100         struct ak881x *ak881x = to_ak881x(client);
 101
 102         v4l_bound_align_image(&mf->width, 0, 720, 2,
 103                               &mf->height, 0, ak881x->lines, 1, 0);
 104         mf->field       = V4L2_FIELD_INTERLACED;
 105         mf->code        = MEDIA_BUS_FMT_YUYV8_2X8;
 106         mf->colorspace  = V4L2_COLORSPACE_SMPTE170M;
 107
 108         return 0;
 109 }
 110
 111 static int ak881x_s_mbus_fmt(struct v4l2_subdev *sd,
 112                              struct v4l2_mbus_framefmt *mf)
 113 {
 114         if (mf->field != V4L2_FIELD_INTERLACED ||
 115             mf->code != MEDIA_BUS_FMT_YUYV8_2X8)
 116                 return -EINVAL;
 117
 118         return ak881x_try_g_mbus_fmt(sd, mf);
 119 }
 120
 121 static int ak881x_enum_mbus_fmt(struct v4l2_subdev *sd, unsigned int index,
 122                                 u32 *code)
 123 {
 124         if (index)
 125                 return -EINVAL;
 126
 127         *code = MEDIA_BUS_FMT_YUYV8_2X8;
 128         return 0;
 129 }
 130
 131 static int ak881x_cropcap(struct v4l2_subdev *sd, struct v4l2_cropcap *a)
 132 {
 133         struct i2c_client *client = v4l2_get_subdevdata(sd);
 134         struct ak881x *ak881x = to_ak881x(client);
 135
 136         a->bounds.left                  = 0;
 137         a->bounds.top                   = 0;
 138         a->bounds.width                 = 720;
 139         a->bounds.height                = ak881x->lines;
 140         a->defrect                      = a->bounds;
 141         a->type                         = V4L2_BUF_TYPE_VIDEO_OUTPUT;
 142         a->pixelaspect.numerator        = 1;
 143         a->pixelaspect.denominator      = 1;
 144
 145         return 0;
 146 }
 147
 148 static int ak881x_s_std_output(struct v4l2_subdev *sd, v4l2_std_id std)
 149 {
 150         struct i2c_client *client = v4l2_get_subdevdata(sd);
 151         struct ak881x *ak881x = to_ak881x(client);
 152         u8 vp1;
 153
 154         if (std == V4L2_STD_NTSC_443) {
 155                 vp1 = 3;
 156                 ak881x->lines = 480;
 157         } else if (std == V4L2_STD_PAL_M) {
 158                 vp1 = 5;
 159                 ak881x->lines = 480;
 160         } else if (std == V4L2_STD_PAL_60) {
 161                 vp1 = 7;
 162                 ak881x->lines = 480;
 163         } else if (std && !(std & ~V4L2_STD_PAL)) {
 164                 vp1 = 0xf;
 165                 ak881x->lines = 576;
 166         } else if (std && !(std & ~V4L2_STD_NTSC)) {
 167                 vp1 = 0;
 168                 ak881x->lines = 480;
 169         } else {
 170                 /* No SECAM or PAL_N/Nc supported */
 171                 return -EINVAL;
 172         }
 173
 174         reg_set(client, AK881X_VIDEO_PROCESS1, vp1, 0xf);
 175
 176         return 0;
 177 }
 178
 179 static int ak881x_s_stream(struct v4l2_subdev *sd, int enable)
 180 {
 181         struct i2c_client *client = v4l2_get_subdevdata(sd);
 182         struct ak881x *ak881x = to_ak881x(client);
 183
 184         if (enable) {
 185                 u8 dac;
 186                 /* For colour-bar testing set bit 6 of AK881X_VIDEO_PROCESS1 */
 187                 /* Default: composite output */
 188                 if (ak881x->pdata->flags & AK881X_COMPONENT)
 189                         dac = 3;
 190                 else
 191                         dac = 4;
 192                 /* Turn on the DAC(s) */
 193                 reg_write(client, AK881X_DAC_MODE, dac);
 194                 dev_dbg(&client->dev, "chip status 0x%x\n",
 195                         reg_read(client, AK881X_STATUS));
 196         } else {
 197                 /* ...and clear bit 6 of AK881X_VIDEO_PROCESS1 here */
 198                 reg_write(client, AK881X_DAC_MODE, 0);
 199                 dev_dbg(&client->dev, "chip status 0x%x\n",
 200                         reg_read(client, AK881X_STATUS));
 201         }
 202
 203         return 0;
 204 }
 205
 206 static struct v4l2_subdev_core_ops ak881x_subdev_core_ops = {
 207 #ifdef CONFIG_VIDEO_ADV_DEBUG
 208         .g_register     = ak881x_g_register,
 209         .s_register     = ak881x_s_register,
 210 #endif
 211 };
 212
 213 static struct v4l2_subdev_video_ops ak881x_subdev_video_ops = {
 214         .s_mbus_fmt     = ak881x_s_mbus_fmt,
 215         .g_mbus_fmt     = ak881x_try_g_mbus_fmt,
 216         .try_mbus_fmt   = ak881x_try_g_mbus_fmt,
 217         .cropcap        = ak881x_cropcap,
 218         .enum_mbus_fmt  = ak881x_enum_mbus_fmt,
 219         .s_std_output   = ak881x_s_std_output,
 220         .s_stream       = ak881x_s_stream,
 221 };
 222
 223 static struct v4l2_subdev_ops ak881x_subdev_ops = {
 224         .core   = &ak881x_subdev_core_ops,
 225         .video  = &ak881x_subdev_video_ops,
 226 };
 227
 228 static int ak881x_probe(struct i2c_client *client,
 229                         const struct i2c_device_id *did)
 230 {
 231         struct i2c_adapter *adapter = to_i2c_adapter(client->dev.parent);
 232         struct ak881x *ak881x;
 233         u8 ifmode, data;
 234
 235         if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) {
 236                 dev_warn(&adapter->dev,
 237                          "I2C-Adapter doesn't support I2C_FUNC_SMBUS_WORD\n");
 238                 return -EIO;
 239         }
 240
 241         ak881x = devm_kzalloc(&client->dev, sizeof(*ak881x), GFP_KERNEL);
 242         if (!ak881x)
 243                 return -ENOMEM;
 244
 245         v4l2_i2c_subdev_init(&ak881x->subdev, client, &ak881x_subdev_ops);
 246
 247         data = reg_read(client, AK881X_DEVICE_ID);
 248
 249         switch (data) {
 250         case 0x13:
 251         case 0x14:
 252                 break;
 253         default:
 254                 dev_err(&client->dev,
 255                         "No ak881x chip detected, register read %x\n", data);
 256                 return -ENODEV;
 257         }
 258
 259         ak881x->revision = reg_read(client, AK881X_DEVICE_REVISION);
 260         ak881x->pdata = client->dev.platform_data;
 261
 262         if (ak881x->pdata) {
 263                 if (ak881x->pdata->flags & AK881X_FIELD)
 264                         ifmode = 4;
 265                 else
 266                         ifmode = 0;
 267
 268                 switch (ak881x->pdata->flags & AK881X_IF_MODE_MASK) {
 269                 case AK881X_IF_MODE_BT656:
 270                         ifmode |= 1;
 271                         break;
 272                 case AK881X_IF_MODE_MASTER:
 273                         ifmode |= 2;
 274                         break;
 275                 case AK881X_IF_MODE_SLAVE:
 276                 default:
 277                         break;
 278                 }
 279
 280                 dev_dbg(&client->dev, "IF mode %x\n", ifmode);
 281
 282                 /*
 283                  * "Line Blanking No." seems to be the same as the number of
 284                  * "black" lines on, e.g., SuperH VOU, whose default value of 20
 285                  * "incidentally" matches ak881x' default
 286                  */
 287                 reg_write(client, AK881X_INTERFACE_MODE, ifmode | (20 << 3));
 288         }
 289
 290         /* Hardware default: NTSC-M */
 291         ak881x->lines = 480;
 292
 293         dev_info(&client->dev, "Detected an ak881x chip ID %x, revision %x\n",
 294                  data, ak881x->revision);
 295
 296         return 0;
 297 }
 298
 299 static int ak881x_remove(struct i2c_client *client)
 300 {
 301         struct ak881x *ak881x = to_ak881x(client);
 302
 303         v4l2_device_unregister_subdev(&ak881x->subdev);
 304
 305         return 0;
 306 }
 307
 308 static const struct i2c_device_id ak881x_id[] = {
 309         { "ak8813", 0 },
 310         { "ak8814", 0 },
 311         { }
 312 };
 313 MODULE_DEVICE_TABLE(i2c, ak881x_id);
 314
 315 static struct i2c_driver ak881x_i2c_driver = {
 316         .driver = {
 317                 .name = "ak881x",
 318         },
 319         .probe          = ak881x_probe,
 320         .remove         = ak881x_remove,
 321         .id_table       = ak881x_id,
 322 };
 323
 324 module_i2c_driver(ak881x_i2c_driver);
 325
 326 MODULE_DESCRIPTION("TV-output driver for ak8813/ak8814");
 327 MODULE_AUTHOR("Guennadi Liakhovetski <g.liakhovetski@gmx.de>");
 328 MODULE_LICENSE("GPL v2");