git.oblomov.eu Git - linux-2.6/blob - drivers/media/video/indycam.c

   1 /*
   2  *  indycam.c - Silicon Graphics IndyCam digital camera driver
   3  *
   4  *  Copyright (C) 2003 Ladislav Michl <ladis@linux-mips.org>
   5  *  Copyright (C) 2004,2005 Mikael Nousiainen <tmnousia@cc.hut.fi>
   6  *
   7  *  This program is free software; you can redistribute it and/or modify
   8  *  it under the terms of the GNU General Public License version 2 as
   9  *  published by the Free Software Foundation.
  10  */
  11
  12 #include <linux/delay.h>
  13 #include <linux/errno.h>
  14 #include <linux/fs.h>
  15 #include <linux/init.h>
  16 #include <linux/kernel.h>
  17 #include <linux/major.h>
  18 #include <linux/module.h>
  19 #include <linux/mm.h>
  20 #include <linux/slab.h>
  21
  22 #include <linux/videodev.h>
  23 /* IndyCam decodes stream of photons into digital image representation ;-) */
  24 #include <linux/video_decoder.h>
  25 #include <linux/i2c.h>
  26
  27 #include "indycam.h"
  28
  29 #define INDYCAM_MODULE_VERSION "0.0.5"
  30
  31 MODULE_DESCRIPTION("SGI IndyCam driver");
  32 MODULE_VERSION(INDYCAM_MODULE_VERSION);
  33 MODULE_AUTHOR("Mikael Nousiainen <tmnousia@cc.hut.fi>");
  34 MODULE_LICENSE("GPL");
  35
  36 // #define INDYCAM_DEBUG
  37
  38 #ifdef INDYCAM_DEBUG
  39 #define dprintk(x...) printk("IndyCam: " x);
  40 #define indycam_regdump(client) indycam_regdump_debug(client)
  41 #else
  42 #define dprintk(x...)
  43 #define indycam_regdump(client)
  44 #endif
  45
  46 struct indycam {
  47         struct i2c_client *client;
  48         u8 version;
  49 };
  50
  51 static struct i2c_driver i2c_driver_indycam;
  52
  53 static const u8 initseq[] = {
  54         INDYCAM_CONTROL_AGCENA,         /* INDYCAM_CONTROL */
  55         INDYCAM_SHUTTER_60,             /* INDYCAM_SHUTTER */
  56         INDYCAM_GAIN_DEFAULT,           /* INDYCAM_GAIN */
  57         0x00,                           /* INDYCAM_BRIGHTNESS (read-only) */
  58         INDYCAM_RED_BALANCE_DEFAULT,    /* INDYCAM_RED_BALANCE */
  59         INDYCAM_BLUE_BALANCE_DEFAULT,   /* INDYCAM_BLUE_BALANCE */
  60         INDYCAM_RED_SATURATION_DEFAULT, /* INDYCAM_RED_SATURATION */
  61         INDYCAM_BLUE_SATURATION_DEFAULT,/* INDYCAM_BLUE_SATURATION */
  62 };
  63
  64 /* IndyCam register handling */
  65
  66 static int indycam_read_reg(struct i2c_client *client, u8 reg, u8 *value)
  67 {
  68         int ret;
  69
  70         if (reg == INDYCAM_REG_RESET) {
  71                 dprintk("indycam_read_reg(): "
  72                         "skipping write-only register %d\n", reg);
  73                 *value = 0;
  74                 return 0;
  75         }
  76
  77         ret = i2c_smbus_read_byte_data(client, reg);
  78
  79         if (ret < 0) {
  80                 printk(KERN_ERR "IndyCam: indycam_read_reg(): read failed, "
  81                        "register = 0x%02x\n", reg);
  82                 return ret;
  83         }
  84
  85         *value = (u8)ret;
  86
  87         return 0;
  88 }
  89
  90 static int indycam_write_reg(struct i2c_client *client, u8 reg, u8 value)
  91 {
  92         int err;
  93
  94         if ((reg == INDYCAM_REG_BRIGHTNESS)
  95             || (reg == INDYCAM_REG_VERSION)) {
  96                 dprintk("indycam_write_reg(): "
  97                         "skipping read-only register %d\n", reg);
  98                 return 0;
  99         }
 100
 101         dprintk("Writing Reg %d = 0x%02x\n", reg, value);
 102         err = i2c_smbus_write_byte_data(client, reg, value);
 103
 104         if (err) {
 105                 printk(KERN_ERR "IndyCam: indycam_write_reg(): write failed, "
 106                        "register = 0x%02x, value = 0x%02x\n", reg, value);
 107         }
 108         return err;
 109 }
 110
 111 static int indycam_write_block(struct i2c_client *client, u8 reg,
 112                                u8 length, u8 *data)
 113 {
 114         int i, err;
 115
 116         for (i = 0; i < length; i++) {
 117                 err = indycam_write_reg(client, reg + i, data[i]);
 118                 if (err)
 119                         return err;
 120         }
 121
 122         return 0;
 123 }
 124
 125 /* Helper functions */
 126
 127 #ifdef INDYCAM_DEBUG
 128 static void indycam_regdump_debug(struct i2c_client *client)
 129 {
 130         int i;
 131         u8 val;
 132
 133         for (i = 0; i < 9; i++) {
 134                 indycam_read_reg(client, i, &val);
 135                 dprintk("Reg %d = 0x%02x\n", i, val);
 136         }
 137 }
 138 #endif
 139
 140 static int indycam_get_control(struct i2c_client *client,
 141                                struct indycam_control *ctrl)
 142 {
 143         struct indycam *camera = i2c_get_clientdata(client);
 144         u8 reg;
 145         int ret = 0;
 146
 147         switch (ctrl->type) {
 148         case INDYCAM_CONTROL_AGC:
 149         case INDYCAM_CONTROL_AWB:
 150                 ret = indycam_read_reg(client, INDYCAM_REG_CONTROL, &reg);
 151                 if (ret)
 152                         return -EIO;
 153                 if (ctrl->type == INDYCAM_CONTROL_AGC)
 154                         ctrl->value = (reg & INDYCAM_CONTROL_AGCENA)
 155                                 ? 1 : 0;
 156                 else
 157                         ctrl->value = (reg & INDYCAM_CONTROL_AWBCTL)
 158                                 ? 1 : 0;
 159                 break;
 160         case INDYCAM_CONTROL_SHUTTER:
 161                 ret = indycam_read_reg(client, INDYCAM_REG_SHUTTER, &reg);
 162                 if (ret)
 163                         return -EIO;
 164                 ctrl->value = ((s32)reg == 0x00) ? 0xff : ((s32)reg - 1);
 165                 break;
 166         case INDYCAM_CONTROL_GAIN:
 167                 ret = indycam_read_reg(client, INDYCAM_REG_GAIN, &reg);
 168                 if (ret)
 169                         return -EIO;
 170                 ctrl->value = (s32)reg;
 171                 break;
 172         case INDYCAM_CONTROL_RED_BALANCE:
 173                 ret = indycam_read_reg(client, INDYCAM_REG_RED_BALANCE, &reg);
 174                 if (ret)
 175                         return -EIO;
 176                 ctrl->value = (s32)reg;
 177                 break;
 178         case INDYCAM_CONTROL_BLUE_BALANCE:
 179                 ret = indycam_read_reg(client, INDYCAM_REG_BLUE_BALANCE, &reg);
 180                 if (ret)
 181                         return -EIO;
 182                 ctrl->value = (s32)reg;
 183                 break;
 184         case INDYCAM_CONTROL_RED_SATURATION:
 185                 ret = indycam_read_reg(client,
 186                                        INDYCAM_REG_RED_SATURATION, &reg);
 187                 if (ret)
 188                         return -EIO;
 189                 ctrl->value = (s32)reg;
 190                 break;
 191         case INDYCAM_CONTROL_BLUE_SATURATION:
 192                 ret = indycam_read_reg(client,
 193                                        INDYCAM_REG_BLUE_SATURATION, &reg);
 194                 if (ret)
 195                         return -EIO;
 196                 ctrl->value = (s32)reg;
 197                 break;
 198         case INDYCAM_CONTROL_GAMMA:
 199                 if (camera->version == CAMERA_VERSION_MOOSE) {
 200                         ret = indycam_read_reg(client,
 201                                                INDYCAM_REG_GAMMA, &reg);
 202                         if (ret)
 203                                 return -EIO;
 204                         ctrl->value = (s32)reg;
 205                 } else {
 206                         ctrl->value = INDYCAM_GAMMA_DEFAULT;
 207                 }
 208                 break;
 209         default:
 210                 ret = -EINVAL;
 211         }
 212
 213         return ret;
 214 }
 215
 216 static int indycam_set_control(struct i2c_client *client,
 217                                struct indycam_control *ctrl)
 218 {
 219         struct indycam *camera = i2c_get_clientdata(client);
 220         u8 reg;
 221         int ret = 0;
 222
 223         switch (ctrl->type) {
 224         case INDYCAM_CONTROL_AGC:
 225         case INDYCAM_CONTROL_AWB:
 226                 ret = indycam_read_reg(client, INDYCAM_REG_CONTROL, &reg);
 227                 if (ret)
 228                         break;
 229
 230                 if (ctrl->type == INDYCAM_CONTROL_AGC) {
 231                         if (ctrl->value)
 232                                 reg |= INDYCAM_CONTROL_AGCENA;
 233                         else
 234                                 reg &= ~INDYCAM_CONTROL_AGCENA;
 235                 } else {
 236                         if (ctrl->value)
 237                                 reg |= INDYCAM_CONTROL_AWBCTL;
 238                         else
 239                                 reg &= ~INDYCAM_CONTROL_AWBCTL;
 240                 }
 241
 242                 ret = indycam_write_reg(client, INDYCAM_REG_CONTROL, reg);
 243                 break;
 244         case INDYCAM_CONTROL_SHUTTER:
 245                 reg = (ctrl->value == 0xff) ? 0x00 : (ctrl->value + 1);
 246                 ret = indycam_write_reg(client, INDYCAM_REG_SHUTTER, reg);
 247                 break;
 248         case INDYCAM_CONTROL_GAIN:
 249                 ret = indycam_write_reg(client, INDYCAM_REG_GAIN, ctrl->value);
 250                 break;
 251         case INDYCAM_CONTROL_RED_BALANCE:
 252                 ret = indycam_write_reg(client, INDYCAM_REG_RED_BALANCE,
 253                                         ctrl->value);
 254                 break;
 255         case INDYCAM_CONTROL_BLUE_BALANCE:
 256                 ret = indycam_write_reg(client, INDYCAM_REG_BLUE_BALANCE,
 257                                         ctrl->value);
 258                 break;
 259         case INDYCAM_CONTROL_RED_SATURATION:
 260                 ret = indycam_write_reg(client, INDYCAM_REG_RED_SATURATION,
 261                                         ctrl->value);
 262                 break;
 263         case INDYCAM_CONTROL_BLUE_SATURATION:
 264                 ret = indycam_write_reg(client, INDYCAM_REG_BLUE_SATURATION,
 265                                         ctrl->value);
 266                 break;
 267         case INDYCAM_CONTROL_GAMMA:
 268                 if (camera->version == CAMERA_VERSION_MOOSE) {
 269                         ret = indycam_write_reg(client, INDYCAM_REG_GAMMA,
 270                                                 ctrl->value);
 271                 }
 272                 break;
 273         default:
 274                 ret = -EINVAL;
 275         }
 276
 277         return ret;
 278 }
 279
 280 /* I2C-interface */
 281
 282 static int indycam_attach(struct i2c_adapter *adap, int addr, int kind)
 283 {
 284         int err = 0;
 285         struct indycam *camera;
 286         struct i2c_client *client;
 287
 288         printk(KERN_INFO "SGI IndyCam driver version %s\n",
 289                INDYCAM_MODULE_VERSION);
 290
 291         client = kzalloc(sizeof(struct i2c_client), GFP_KERNEL);
 292         if (!client)
 293                 return -ENOMEM;
 294         camera = kzalloc(sizeof(struct indycam), GFP_KERNEL);
 295         if (!camera) {
 296                 err = -ENOMEM;
 297                 goto out_free_client;
 298         }
 299
 300         client->addr = addr;
 301         client->adapter = adap;
 302         client->driver = &i2c_driver_indycam;
 303         client->flags = 0;
 304         strcpy(client->name, "IndyCam client");
 305         i2c_set_clientdata(client, camera);
 306
 307         camera->client = client;
 308
 309         err = i2c_attach_client(client);
 310         if (err)
 311                 goto out_free_camera;
 312
 313         camera->version = i2c_smbus_read_byte_data(client,
 314                                                    INDYCAM_REG_VERSION);
 315         if (camera->version != CAMERA_VERSION_INDY &&
 316             camera->version != CAMERA_VERSION_MOOSE) {
 317                 err = -ENODEV;
 318                 goto out_detach_client;
 319         }
 320         printk(KERN_INFO "IndyCam v%d.%d detected\n",
 321                INDYCAM_VERSION_MAJOR(camera->version),
 322                INDYCAM_VERSION_MINOR(camera->version));
 323
 324         indycam_regdump(client);
 325
 326         // initialize
 327         err = indycam_write_block(client, 0, sizeof(initseq), (u8 *)&initseq);
 328         if (err) {
 329                 printk(KERN_ERR "IndyCam initalization failed\n");
 330                 err = -EIO;
 331                 goto out_detach_client;
 332         }
 333
 334         indycam_regdump(client);
 335
 336         // white balance
 337         err = indycam_write_reg(client, INDYCAM_REG_CONTROL,
 338                           INDYCAM_CONTROL_AGCENA | INDYCAM_CONTROL_AWBCTL);
 339         if (err) {
 340                 printk(KERN_ERR "IndyCam: White balancing camera failed\n");
 341                 err = -EIO;
 342                 goto out_detach_client;
 343         }
 344
 345         indycam_regdump(client);
 346
 347         printk(KERN_INFO "IndyCam initialized\n");
 348
 349         return 0;
 350
 351 out_detach_client:
 352         i2c_detach_client(client);
 353 out_free_camera:
 354         kfree(camera);
 355 out_free_client:
 356         kfree(client);
 357         return err;
 358 }
 359
 360 static int indycam_probe(struct i2c_adapter *adap)
 361 {
 362         /* Indy specific crap */
 363         if (adap->id == I2C_HW_SGI_VINO)
 364                 return indycam_attach(adap, INDYCAM_ADDR, 0);
 365         /* Feel free to add probe here :-) */
 366         return -ENODEV;
 367 }
 368
 369 static int indycam_detach(struct i2c_client *client)
 370 {
 371         struct indycam *camera = i2c_get_clientdata(client);
 372
 373         i2c_detach_client(client);
 374         kfree(camera);
 375         kfree(client);
 376         return 0;
 377 }
 378
 379 static int indycam_command(struct i2c_client *client, unsigned int cmd,
 380                            void *arg)
 381 {
 382         // struct indycam *camera = i2c_get_clientdata(client);
 383
 384         /* The old video_decoder interface just isn't enough,
 385          * so we'll use some custom commands. */
 386         switch (cmd) {
 387         case DECODER_GET_CAPABILITIES: {
 388                 struct video_decoder_capability *cap = arg;
 389
 390                 cap->flags  = VIDEO_DECODER_NTSC;
 391                 cap->inputs = 1;
 392                 cap->outputs = 1;
 393                 break;
 394         }
 395         case DECODER_GET_STATUS: {
 396                 int *iarg = arg;
 397
 398                 *iarg = DECODER_STATUS_GOOD | DECODER_STATUS_NTSC |
 399                         DECODER_STATUS_COLOR;
 400                 break;
 401         }
 402         case DECODER_SET_NORM: {
 403                 int *iarg = arg;
 404
 405                 switch (*iarg) {
 406                 case VIDEO_MODE_NTSC:
 407                         break;
 408                 default:
 409                         return -EINVAL;
 410                 }
 411                 break;
 412         }
 413         case DECODER_SET_INPUT: {
 414                 int *iarg = arg;
 415
 416                 if (*iarg != 0)
 417                         return -EINVAL;
 418                 break;
 419         }
 420         case DECODER_SET_OUTPUT: {
 421                 int *iarg = arg;
 422
 423                 if (*iarg != 0)
 424                         return -EINVAL;
 425                 break;
 426         }
 427         case DECODER_ENABLE_OUTPUT: {
 428                 /* Always enabled */
 429                 break;
 430         }
 431         case DECODER_SET_PICTURE: {
 432                 // struct video_picture *pic = arg;
 433                 /* TODO: convert values for indycam_set_controls() */
 434                 break;
 435         }
 436         case DECODER_INDYCAM_GET_CONTROL: {
 437                 return indycam_get_control(client, arg);
 438         }
 439         case DECODER_INDYCAM_SET_CONTROL: {
 440                 return indycam_set_control(client, arg);
 441         }
 442         default:
 443                 return -EINVAL;
 444         }
 445
 446         return 0;
 447 }
 448
 449 static struct i2c_driver i2c_driver_indycam = {
 450         .driver = {
 451                 .name   = "indycam",
 452         },
 453         .id             = I2C_DRIVERID_INDYCAM,
 454         .attach_adapter = indycam_probe,
 455         .detach_client  = indycam_detach,
 456         .command        = indycam_command,
 457 };
 458
 459 static int __init indycam_init(void)
 460 {
 461         return i2c_add_driver(&i2c_driver_indycam);
 462 }
 463
 464 static void __exit indycam_exit(void)
 465 {
 466         i2c_del_driver(&i2c_driver_indycam);
 467 }
 468
 469 module_init(indycam_init);
 470 module_exit(indycam_exit);