arch/arm/mach-omap2/board-n800-camera.c

   1 /*
   2  * arch/arm/mach-omap2/board-n800-camera.c
   3  *
   4  * Copyright (C) 2007 Nokia Corporation
   5  *
   6  * Contact: Sakari Ailus <sakari.ailus@nokia.com>
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License
  10  * version 2 as published by the Free Software Foundation.
  11  *
  12  * This program is distributed in the hope that it will be useful, but
  13  * WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  15  * General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License
  18  * along with this program; if not, write to the Free Software
  19  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
  20  * 02110-1301 USA
  21  *
  22  */
  23
  24 #include <linux/clk.h>
  25 #include <linux/platform_device.h>
  26 #include <linux/delay.h>
  27 #include <linux/videodev2.h>
  28 #include <linux/gpio.h>
  29 #include <linux/i2c/menelaus.h>
  30
  31 #include <media/v4l2-int-device.h>
  32
  33 #include <asm/mach-types.h>
  34
  35 #include <mach/board.h>
  36
  37 #include <../drivers/cbus/retu.h>
  38 #include <../drivers/media/video/tcm825x.h>
  39
  40 #include "board-n800.h"
  41
  42 #if defined (CONFIG_VIDEO_TCM825X) || defined (CONFIG_VIDEO_TCM825X_MODULE)
  43
  44 #define OMAP24XX_CAMERA_JAM_HACK
  45
  46 #ifdef OMAP24XX_CAMERA_JAM_HACK
  47 /*
  48  * We don't need to check every pixel to assume that the frame is
  49  * corrupt and the sensor is jammed. CHECK_X and CHECK_Y are the
  50  * number of u32s to check per line / row, plus there are two lines in
  51  * the bottom of the frame.
  52  */
  53 #define CHECK_X 8
  54 #define CHECK_Y 6
  55 /*
  56  * Start checking after this many frames since resetting the sensor.
  57  * Sometimes the first frame(s) is(/are) black which could trigger
  58  * unwanted reset(s).
  59  */
  60 #define JAM_CHECK_AFTER 3
  61 /*
  62  * If the sensor is quickly brought into bright conditions from dark,
  63  * it may temporarily be saturated, leaving out the normal background
  64  * noise. This many saturated frames may go through before the sensor
  65  * is considered jammed.
  66  */
  67 #define SATURATED_MAX 30
  68 #endif
  69
  70 #define N800_CAM_SENSOR_RESET_GPIO      53
  71
  72 static int sensor_okay;
  73 #ifdef OMAP24XX_CAMERA_JAM_HACK
  74 static int frames_after_reset;
  75 static int saturated_count;
  76 #endif
  77
  78 const static struct tcm825x_reg tcm825x_regs_n800[] = {
  79         /* initial settings for 2.5 V */
  80         {0x00, 0x03}, {0x03, 0x29}, {0xaa, 0x2a}, {0xc0, 0x2b},
  81         {0x10, 0x2c}, {0x4c, 0x2d}, {0x9c, 0x3f},
  82
  83         /* main settings */
  84         {0x00, 0x00}, {0x30, 0x01}, {0x0e, 0x02}, /* initial */
  85         {0x0f, 0x04}, {0x02, 0x05}, {0x0d, 0x06}, {0xc0, 0x07},
  86         {0x38, 0x08}, {0x50, 0x09}, {0x80, 0x0a}, {0x40, 0x0b},
  87         {0x40, 0x0c}, {0x00, 0x0d}, {0x04, 0x0e}, {0x04, 0x0f},
  88         {0x22, 0x10}, {0x96, 0x11}, {0xf0, 0x12}, {0x08, 0x13},
  89         {0x08, 0x14}, {0x30, 0x15}, {0x30, 0x16}, {0x01, 0x17},
  90         {0x40, 0x18}, {0x87, 0x19}, {0x2b, 0x1a}, {0x84, 0x1b},
  91         {0x52, 0x1c}, {0x44, 0x1d}, {0x68, 0x1e}, {0x00, 0x1f},
  92         {0x00, 0x20}, {0x01, 0x21}, {0x27, 0x22}, {0x40, 0x23},
  93         {0x27, 0x24}, {0x5f, 0x25}, {0x00, 0x26}, {0x16, 0x27},
  94         {0x23, 0x28}, /* initial */ /* initial */ /* initial */
  95         /* initial */ /* initial */ {0x00, 0x2e}, {0x00, 0x2f},
  96         {0x00, 0x30}, {0x00, 0x31}, {0x00, 0x32}, {0x00, 0x33},
  97         {0x00, 0x34}, {0x00, 0x35}, {0x00, 0x36}, {0x00, 0x37},
  98         {0x00, 0x38}, {0x8c, 0x39}, {0xc8, 0x3A}, {0x80, 0x3b},
  99         {0x00, 0x3c}, {0x17, 0x3d}, {0x85, 0x3e}, /* initial */
 100         {0xa0, 0x40}, {0x00, 0x41}, {0x00, 0x42}, {0x00, 0x43},
 101         {0x08, 0x44}, {0x12, 0x45}, {0x00, 0x46}, {0x20, 0x47},
 102         {0x30, 0x48}, {0x18, 0x49}, {0x20, 0x4a}, {0x4d, 0x4b},
 103         {0x0c, 0x4c}, {0xe0, 0x4d}, {0x20, 0x4e}, {0x89, 0x4f},
 104         {0x21, 0x50}, {0x80, 0x51}, {0x02, 0x52}, {0x00, 0x53},
 105         {0x30, 0x54}, {0x90, 0x55}, {0x40, 0x56}, {0x06, 0x57},
 106         {0x0f, 0x58}, {0x23, 0x59}, {0x08, 0x5A}, {0x04, 0x5b},
 107         {0x08, 0x5c}, {0x08, 0x5d}, {0x08, 0x5e}, {0x08, 0x5f},
 108         {TCM825X_VAL_TERM, TCM825X_REG_TERM}
 109 };
 110
 111 const static struct tcm825x_reg tcm825x_regs_n810[] = {
 112         /* initial settings for 2.5 V */
 113         {0x00, 0x03}, {0x03, 0x29}, {0xaa, 0x2a}, {0xc0, 0x2b},
 114         {0x10, 0x2c}, {0x4c, 0x2d}, {0x9c, 0x3f},
 115
 116         /* main settings */
 117         {0x00, 0x00}, {0x30, 0x01}, {0x0e, 0x02}, /* initial */
 118         {0xcf, 0x04}, {0x02, 0x05}, {0x0d, 0x06}, {0xc0, 0x07},
 119         {0x38, 0x08}, {0x50, 0x09}, {0x80, 0x0a}, {0x40, 0x0b},
 120         {0x40, 0x0c}, {0x00, 0x0d}, {0x04, 0x0e}, {0x04, 0x0f},
 121         {0x22, 0x10}, {0x96, 0x11}, {0xf0, 0x12}, {0x08, 0x13},
 122         {0x08, 0x14}, {0x30, 0x15}, {0x30, 0x16}, {0x01, 0x17},
 123         {0x40, 0x18}, {0x87, 0x19}, {0x2b, 0x1a}, {0x84, 0x1b},
 124         {0x52, 0x1c}, {0x44, 0x1d}, {0x68, 0x1e}, {0x00, 0x1f},
 125         {0x00, 0x20}, {0x01, 0x21}, {0x27, 0x22}, {0x40, 0x23},
 126         {0x27, 0x24}, {0x5f, 0x25}, {0x00, 0x26}, {0x16, 0x27},
 127         {0x23, 0x28}, /* initial */ /* initial */ /* initial */
 128         /* initial */ /* initial */ {0x00, 0x2e}, {0x00, 0x2f},
 129         {0x00, 0x30}, {0x00, 0x31}, {0x00, 0x32}, {0x00, 0x33},
 130         {0x00, 0x34}, {0x00, 0x35}, {0x00, 0x36}, {0x00, 0x37},
 131         {0x00, 0x38}, {0x8c, 0x39}, {0xc8, 0x3A}, {0x80, 0x3b},
 132         {0x00, 0x3c}, {0x17, 0x3d}, {0x85, 0x3e}, /* initial */
 133         {0xa0, 0x40}, {0x00, 0x41}, {0x00, 0x42}, {0x00, 0x43},
 134         {0x08, 0x44}, {0x12, 0x45}, {0x00, 0x46}, {0x20, 0x47},
 135         {0x30, 0x48}, {0x18, 0x49}, {0x20, 0x4a}, {0x4d, 0x4b},
 136         {0x0c, 0x4c}, {0xe0, 0x4d}, {0x20, 0x4e}, {0x89, 0x4f},
 137         {0x21, 0x50}, {0x80, 0x51}, {0x02, 0x52}, {0x00, 0x53},
 138         {0x30, 0x54}, {0x90, 0x55}, {0x40, 0x56}, {0x06, 0x57},
 139         {0x0f, 0x58}, {0x23, 0x59}, {0x08, 0x5A}, {0x04, 0x5b},
 140         {0x08, 0x5c}, {0x08, 0x5d}, {0x08, 0x5e}, {0x08, 0x5f},
 141         {TCM825X_VAL_TERM, TCM825X_REG_TERM}
 142 };
 143
 144 static int tcm825x_is_okay(void)
 145 {
 146         return sensor_okay;
 147 }
 148
 149 /*
 150  * VSIM1        --> CAM_IOVDD   --> IOVDD (1.8 V)
 151  */
 152 static int tcm825x_power_on(void)
 153 {
 154         int ret;
 155
 156         /* Set VMEM to 1.5V and VIO to 2.5V */
 157         ret = menelaus_set_vmem(1500);
 158         if (ret < 0) {
 159                 /* Try once more, it seems the sensor power up causes
 160                  * some problems on the I2C bus. */
 161                 ret = menelaus_set_vmem(1500);
 162                 if (ret < 0)
 163                         return ret;
 164         }
 165         msleep(1);
 166
 167         ret = menelaus_set_vio(2500);
 168         if (ret < 0)
 169                 return ret;
 170
 171         /* Set VSim1 on */
 172         retu_write_reg(RETU_REG_CTRL_SET, 0x0080);
 173         msleep(1);
 174
 175         gpio_set_value(N800_CAM_SENSOR_RESET_GPIO, 1);
 176         msleep(1);
 177
 178         saturated_count = 0;
 179         frames_after_reset = 0;
 180
 181         return 0;
 182 }
 183
 184 static int tcm825x_power_off(void)
 185 {
 186         int ret;
 187
 188         gpio_set_value(N800_CAM_SENSOR_RESET_GPIO, 0);
 189         msleep(1);
 190
 191         /* Set VSim1 off */
 192         retu_write_reg(RETU_REG_CTRL_CLR, 0x0080);
 193         msleep(1);
 194
 195         /* Set VIO_MODE to off */
 196         ret = menelaus_set_vio(0);
 197         if (ret < 0)
 198                 return ret;
 199         msleep(1);
 200
 201         /* Set VMEM_MODE to off */
 202         ret = menelaus_set_vmem(0);
 203         if (ret < 0)
 204                 return ret;
 205         msleep(1);
 206
 207         return 0;
 208 }
 209
 210 static int tcm825x_power_set(int power)
 211 {
 212         BUG_ON(!sensor_okay);
 213
 214         if (power)
 215                 return tcm825x_power_on();
 216         else
 217                 return tcm825x_power_off();
 218 }
 219
 220 static const struct tcm825x_reg *tcm825x_default_regs(void)
 221 {
 222         if (machine_is_nokia_n810())
 223                 return tcm825x_regs_n810;
 224
 225         return tcm825x_regs_n800;
 226 }
 227
 228 #ifdef OMAP24XX_CAMERA_JAM_HACK
 229 /*
 230  * Check for jammed sensor, in which case all horizontal lines are
 231  * equal. Handle also case where sensor could be saturated awhile in
 232  * case of rapid increase of brightness.
 233  */
 234 static int tcm825x_needs_reset(struct v4l2_int_device *s, void *buf,
 235                                struct v4l2_pix_format *pix)
 236 {
 237         int i, j;
 238         uint32_t xor, xor2;
 239         uint32_t offset;
 240         uint32_t dx_offset;
 241         uint32_t saturated_pattern;
 242         int is_saturated = 1;
 243
 244         switch (pix->pixelformat) {
 245         default:
 246         case V4L2_PIX_FMT_RGB565:
 247                 saturated_pattern = 0xffffffff; /* guess */
 248                 break;
 249         case V4L2_PIX_FMT_UYVY:
 250                 saturated_pattern = 0xe080e080;
 251                 break;
 252         }
 253
 254         /* This won't work for height under 2 at all. */
 255         if (pix->height < 2)
 256                 return 0;
 257         /* Check that there is enough image data. */
 258         if (pix->width * TCM825X_BYTES_PER_PIXEL < sizeof(uint32_t))
 259                 return 0;
 260         /*
 261          * Don't check for jamming immediately. Sometimes frames
 262          * immediately after reset are black.
 263          */
 264         if (frames_after_reset < JAM_CHECK_AFTER) {
 265                 frames_after_reset++;
 266                 return 0;
 267         }
 268
 269         dx_offset = ((pix->width - sizeof(uint32_t) / TCM825X_BYTES_PER_PIXEL)
 270                      * TCM825X_BYTES_PER_PIXEL) / (CHECK_X - 1);
 271         dx_offset = dx_offset - dx_offset % TCM825X_BYTES_PER_PIXEL;
 272         /*
 273          * Check two lines in the bottom first. They're unlikely to be
 274          * saturated and quick to check.
 275          */
 276         offset = (pix->height - 2) * pix->bytesperline;
 277         xor = xor2 = 0;
 278         for (j = 0; j < CHECK_X; j++) {
 279                 uint32_t *val = buf + offset;
 280                 uint32_t *val2 = buf + offset + pix->bytesperline;
 281                 xor ^= *val;
 282                 if (*val != saturated_pattern)
 283                         is_saturated = 0;
 284                 xor2 ^= *val2;
 285                 if (xor2 != xor) {
 286                         saturated_count = 0;
 287                         return 0;
 288                 }
 289                 offset += dx_offset;
 290         }
 291         /* Check the rest of the picture. */
 292         offset = 0;
 293         for (i = 0; i < CHECK_Y; i++) {
 294                 uint32_t offset2 = offset;
 295                 xor2 = 0;
 296                 for (j = 0; j < CHECK_X; j++) {
 297                         uint32_t *val = buf + offset2;
 298                         xor2 ^= *val;
 299                         offset2 += dx_offset;
 300                 }
 301                 if (xor2 != xor) {
 302                         saturated_count = 0;
 303                         return 0;
 304                 }
 305                 offset += pix->bytesperline * ((pix->height - 2) / CHECK_Y);
 306         }
 307
 308         if (is_saturated && saturated_count++ < SATURATED_MAX)
 309                 return 0;
 310
 311         return -EIO;
 312 }
 313 #else
 314 static int tcm825x_needs_reset(struct v4l2_int_device *s, void *buf,
 315                                struct v4l2_pix_format *pix)
 316 {
 317         return 0;
 318 }
 319 #endif
 320
 321 static const struct v4l2_ifparm ifparm = {
 322         .if_type = V4L2_IF_TYPE_BT656,
 323         .u = {
 324                 .bt656 = {
 325                          .frame_start_on_rising_vs = 1,
 326                          .latch_clk_inv = 1,
 327                          .mode = V4L2_IF_TYPE_BT656_MODE_NOBT_8BIT,
 328                          .clock_min = TCM825X_XCLK_MIN,
 329                          .clock_max = TCM825X_XCLK_MAX,
 330                  },
 331         },
 332 };
 333
 334 static int tcm825x_ifparm(struct v4l2_ifparm *p)
 335 {
 336         *p = ifparm;
 337
 338         return 0;
 339 }
 340
 341 static int tcm825x_is_upside_down(void)
 342 {
 343         return machine_is_nokia_n810();
 344 }
 345
 346 const struct tcm825x_platform_data n800_tcm825x_platform_data = {
 347         .is_okay        = tcm825x_is_okay,
 348         .power_set      = tcm825x_power_set,
 349         .default_regs   = tcm825x_default_regs,
 350         .needs_reset    = tcm825x_needs_reset,
 351         .ifparm         = tcm825x_ifparm,
 352         .is_upside_down = tcm825x_is_upside_down,
 353 };
 354
 355 void __init n800_cam_init(void)
 356 {
 357         int r;
 358
 359         r = gpio_request(N800_CAM_SENSOR_RESET_GPIO, "TCM825x reset");
 360         if (r < 0) {
 361                 printk(KERN_WARNING "%s: failed to request gpio\n",
 362                         __func__);
 363                 return;
 364         }
 365
 366         gpio_direction_output(N800_CAM_SENSOR_RESET_GPIO, 0);
 367
 368         sensor_okay = 1;
 369 }
 370
 371 #else
 372 void __init n800_cam_init(void)
 373 {
 374 }
 375
 376 #endif