mirror of https://gitee.com/openkylin/linux.git
192 lines
5.2 KiB
C
192 lines
5.2 KiB
C
|
/*
|
||
|
* The Capture code for Fujitsu M-5MOLS ISP
|
||
|
*
|
||
|
* Copyright (C) 2011 Samsung Electronics Co., Ltd.
|
||
|
* Author: HeungJun Kim, riverful.kim@samsung.com
|
||
|
*
|
||
|
* Copyright (C) 2009 Samsung Electronics Co., Ltd.
|
||
|
* Author: Dongsoo Nathaniel Kim, dongsoo45.kim@samsung.com
|
||
|
*
|
||
|
* This program is free software; you can redistribute it and/or modify
|
||
|
* it under the terms of the GNU General Public License as published by
|
||
|
* the Free Software Foundation; either version 2 of the License, or
|
||
|
* (at your option) any later version.
|
||
|
*/
|
||
|
|
||
|
#include <linux/i2c.h>
|
||
|
#include <linux/slab.h>
|
||
|
#include <linux/irq.h>
|
||
|
#include <linux/interrupt.h>
|
||
|
#include <linux/delay.h>
|
||
|
#include <linux/version.h>
|
||
|
#include <linux/gpio.h>
|
||
|
#include <linux/regulator/consumer.h>
|
||
|
#include <linux/videodev2.h>
|
||
|
#include <linux/version.h>
|
||
|
#include <media/v4l2-ctrls.h>
|
||
|
#include <media/v4l2-device.h>
|
||
|
#include <media/v4l2-subdev.h>
|
||
|
#include <media/m5mols.h>
|
||
|
|
||
|
#include "m5mols.h"
|
||
|
#include "m5mols_reg.h"
|
||
|
|
||
|
static int m5mols_capture_error_handler(struct m5mols_info *info,
|
||
|
int timeout)
|
||
|
{
|
||
|
int ret;
|
||
|
|
||
|
/* Disable all interrupts and clear relevant interrupt staus bits */
|
||
|
ret = m5mols_write(&info->sd, SYSTEM_INT_ENABLE,
|
||
|
info->interrupt & ~(REG_INT_CAPTURE));
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
if (timeout == 0)
|
||
|
return -ETIMEDOUT;
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
/**
|
||
|
* m5mols_read_rational - I2C read of a rational number
|
||
|
*
|
||
|
* Read numerator and denominator from registers @addr_num and @addr_den
|
||
|
* respectively and return the division result in @val.
|
||
|
*/
|
||
|
static int m5mols_read_rational(struct v4l2_subdev *sd, u32 addr_num,
|
||
|
u32 addr_den, u32 *val)
|
||
|
{
|
||
|
u32 num, den;
|
||
|
|
||
|
int ret = m5mols_read(sd, addr_num, &num);
|
||
|
if (!ret)
|
||
|
ret = m5mols_read(sd, addr_den, &den);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
*val = den == 0 ? 0 : num / den;
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* m5mols_capture_info - Gather captured image information
|
||
|
*
|
||
|
* For now it gathers only EXIF information and file size.
|
||
|
*/
|
||
|
static int m5mols_capture_info(struct m5mols_info *info)
|
||
|
{
|
||
|
struct m5mols_exif *exif = &info->cap.exif;
|
||
|
struct v4l2_subdev *sd = &info->sd;
|
||
|
int ret;
|
||
|
|
||
|
ret = m5mols_read_rational(sd, EXIF_INFO_EXPTIME_NU,
|
||
|
EXIF_INFO_EXPTIME_DE, &exif->exposure_time);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
ret = m5mols_read_rational(sd, EXIF_INFO_TV_NU, EXIF_INFO_TV_DE,
|
||
|
&exif->shutter_speed);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
ret = m5mols_read_rational(sd, EXIF_INFO_AV_NU, EXIF_INFO_AV_DE,
|
||
|
&exif->aperture);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
ret = m5mols_read_rational(sd, EXIF_INFO_BV_NU, EXIF_INFO_BV_DE,
|
||
|
&exif->brightness);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
ret = m5mols_read_rational(sd, EXIF_INFO_EBV_NU, EXIF_INFO_EBV_DE,
|
||
|
&exif->exposure_bias);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
ret = m5mols_read(sd, EXIF_INFO_ISO, (u32 *)&exif->iso_speed);
|
||
|
if (!ret)
|
||
|
ret = m5mols_read(sd, EXIF_INFO_FLASH, (u32 *)&exif->flash);
|
||
|
if (!ret)
|
||
|
ret = m5mols_read(sd, EXIF_INFO_SDR, (u32 *)&exif->sdr);
|
||
|
if (!ret)
|
||
|
ret = m5mols_read(sd, EXIF_INFO_QVAL, (u32 *)&exif->qval);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
if (!ret)
|
||
|
ret = m5mols_read(sd, CAPC_IMAGE_SIZE, &info->cap.main);
|
||
|
if (!ret)
|
||
|
ret = m5mols_read(sd, CAPC_THUMB_SIZE, &info->cap.thumb);
|
||
|
if (!ret)
|
||
|
info->cap.total = info->cap.main + info->cap.thumb;
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
int m5mols_start_capture(struct m5mols_info *info)
|
||
|
{
|
||
|
struct v4l2_subdev *sd = &info->sd;
|
||
|
u32 resolution = info->resolution;
|
||
|
int timeout;
|
||
|
int ret;
|
||
|
|
||
|
/*
|
||
|
* Preparing capture. Setting control & interrupt before entering
|
||
|
* capture mode
|
||
|
*
|
||
|
* 1) change to MONITOR mode for operating control & interrupt
|
||
|
* 2) set controls (considering v4l2_control value & lock 3A)
|
||
|
* 3) set interrupt
|
||
|
* 4) change to CAPTURE mode
|
||
|
*/
|
||
|
ret = m5mols_mode(info, REG_MONITOR);
|
||
|
if (!ret)
|
||
|
ret = m5mols_sync_controls(info);
|
||
|
if (!ret)
|
||
|
ret = m5mols_lock_3a(info, true);
|
||
|
if (!ret)
|
||
|
ret = m5mols_enable_interrupt(sd, REG_INT_CAPTURE);
|
||
|
if (!ret)
|
||
|
ret = m5mols_mode(info, REG_CAPTURE);
|
||
|
if (!ret) {
|
||
|
/* Wait for capture interrupt, after changing capture mode */
|
||
|
timeout = wait_event_interruptible_timeout(info->irq_waitq,
|
||
|
test_bit(ST_CAPT_IRQ, &info->flags),
|
||
|
msecs_to_jiffies(2000));
|
||
|
if (test_and_clear_bit(ST_CAPT_IRQ, &info->flags))
|
||
|
ret = m5mols_capture_error_handler(info, timeout);
|
||
|
}
|
||
|
if (!ret)
|
||
|
ret = m5mols_lock_3a(info, false);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
/*
|
||
|
* Starting capture. Setting capture frame count and resolution and
|
||
|
* the format(available format: JPEG, Bayer RAW, YUV).
|
||
|
*
|
||
|
* 1) select single or multi(enable to 25), format, size
|
||
|
* 2) set interrupt
|
||
|
* 3) start capture(for main image, now)
|
||
|
* 4) get information
|
||
|
* 5) notify file size to v4l2 device(e.g, to s5p-fimc v4l2 device)
|
||
|
*/
|
||
|
ret = m5mols_write(sd, CAPC_SEL_FRAME, 1);
|
||
|
if (!ret)
|
||
|
ret = m5mols_write(sd, CAPP_YUVOUT_MAIN, REG_JPEG);
|
||
|
if (!ret)
|
||
|
ret = m5mols_write(sd, CAPP_MAIN_IMAGE_SIZE, resolution);
|
||
|
if (!ret)
|
||
|
ret = m5mols_enable_interrupt(sd, REG_INT_CAPTURE);
|
||
|
if (!ret)
|
||
|
ret = m5mols_write(sd, CAPC_START, REG_CAP_START_MAIN);
|
||
|
if (!ret) {
|
||
|
/* Wait for the capture completion interrupt */
|
||
|
timeout = wait_event_interruptible_timeout(info->irq_waitq,
|
||
|
test_bit(ST_CAPT_IRQ, &info->flags),
|
||
|
msecs_to_jiffies(2000));
|
||
|
if (test_and_clear_bit(ST_CAPT_IRQ, &info->flags)) {
|
||
|
ret = m5mols_capture_info(info);
|
||
|
if (!ret)
|
||
|
v4l2_subdev_notify(sd, 0, &info->cap.total);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return m5mols_capture_error_handler(info, timeout);
|
||
|
}
|